LuatOS/components/i2c-tools/i2c_utils.c

#include "luat_base.h"
#include "i2c_utils.h"
#include "luat_i2c.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){
    i2c_tools_id = i2c_id;
    return (luat_i2c_setup(i2c_tools_id, 0));
}

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){
    LLOGD("ID  0  1  2  3  4  5  6  7  8  9  a  b  c  d  e  f");
    char buff[64] = {0};
    for(unsigned char i=0; i<8; i++){
        sprintf_(buff, "%d0: ", i);
        for(unsigned char j=0; j<16; j++){
            char addr = i*16+j;
            if( i2c_probe(addr) == 1){
                sprintf_(buff + 4 + j*3, "%02X ", addr);
            }else{
                sprintf_(buff + 4 + j*3, "-- ");
            }
        }
        LLOGD("%s", buff);
    }
}