LuatOS/components/i2c-tools/i2c_utils.c

#include "luat_base.h"
#include "i2c_utils.h"
#include "luat_i2c.h"
#include "luat_mem.h"

#define LUAT_LOG_TAG "i2c"
#include "luat_log.h"


static uint8_t i2c_tools_id = 0;

uint8_t strtonum(const char* str){
    uint8_t data;
    if (strcmp(str, "0x")){
        data = (uint8_t)strtol(str, NULL, 0);
    }else{
        data = atoi(str);
    }
    return data;
}

void i2c_help(void){
    LLOGD("---------------i2c tools help:---------------");
    LLOGD("i2c tools scan i2c_id");
    LLOGD("i2c tools recv i2c_id address register [len=1]");
    LLOGD("i2c tools send i2c_id address [register] data_0 data_1 ...");
}

uint8_t i2c_init(const uint8_t i2c_id, int speed){
    i2c_tools_id = i2c_id;
    return (luat_i2c_setup(i2c_tools_id, speed));
}

uint8_t i2c_probe(char addr){
	uint8_t data[2] = {0x00};
    return (luat_i2c_send(i2c_tools_id, addr, data, 2,1) ==0);
}

uint8_t i2c_write(char addr, uint8_t* data, int len){
    return (luat_i2c_send(i2c_tools_id, addr, data, len,1) == 0);
}

uint8_t i2c_read(uint8_t addr, uint8_t reg, uint8_t* buffer, uint8_t len){
    int ret = 0;
    ret = luat_i2c_send(i2c_tools_id, addr, &reg, 1,0);
    if (ret != 0)return -1;
    ret = luat_i2c_recv(i2c_tools_id, addr, buffer, len);
    if (ret != 0)return -1;
    return 0;
}

void i2c_scan(void){
    uint16_t len = 0;
    char *scan_buff = luat_heap_malloc(512);
    memset(scan_buff, 0, 512);
    for(unsigned char i=0; i<8; i++){
        sprintf_(scan_buff + len, "%d0: ", i);
        len++;
        for(unsigned char j=0; j<16; j++){
            uint8_t addr = (uint8_t)(i*16+j);
            len+=3;
            if( i2c_probe(addr) == 1){
                sprintf_(scan_buff + len, "%02X ", addr);
            }else{
                sprintf_(scan_buff + len, "-- ");
            }
        }
        len+=3;
        sprintf_(scan_buff + len, "\n");
        len++;
    }
    LLOGD("\nID  0  1  2  3  4  5  6  7  8  9  a  b  c  d  e  f\n%s",scan_buff);
    luat_heap_free(scan_buff);
}