71 lines
1.1 KiB
C
71 lines
1.1 KiB
C
|
#include <stdint.h>
|
||
|
#include <stdlib.h>
|
||
|
#include <inttypes.h>
|
||
|
#include <unistd.h>
|
||
|
#include <stdio.h>
|
||
|
#include <string.h>
|
||
|
#include <fcntl.h>
|
||
|
#include <sys/ioctl.h>
|
||
|
#include <linux/i2c-dev.h>
|
||
|
|
||
|
static int file_i2c = 0;
|
||
|
|
||
|
uint8_t _i2c_init(int i2c, int dev_addr)
|
||
|
{
|
||
|
if (file_i2c == 0)
|
||
|
{
|
||
|
char filename[32];
|
||
|
sprintf(filename, "/dev/i2c-%d", i2c); // I2C bus number passed
|
||
|
file_i2c = open(filename, O_RDWR);
|
||
|
if (file_i2c < 0)
|
||
|
{
|
||
|
file_i2c = 0;
|
||
|
return 1;
|
||
|
}
|
||
|
if (ioctl(file_i2c, I2C_SLAVE, dev_addr) < 0) // set slave address
|
||
|
{
|
||
|
close(file_i2c);
|
||
|
file_i2c = 0;
|
||
|
return 1;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
// assume done init already
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
uint8_t _i2c_close()
|
||
|
{
|
||
|
if (file_i2c != 0)
|
||
|
{
|
||
|
close(file_i2c);
|
||
|
file_i2c = 0;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
uint8_t _i2c_write(uint8_t* ptr, int16_t len)
|
||
|
{
|
||
|
if (file_i2c == 0 || ptr == 0 || len <= 0)
|
||
|
return 1;
|
||
|
|
||
|
int32_t rc;
|
||
|
rc = write(file_i2c, ptr, len);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
uint8_t _i2c_read(uint8_t *ptr, int16_t len)
|
||
|
{
|
||
|
if (file_i2c == 0 || ptr == 0 || len <= 0)
|
||
|
return 1;
|
||
|
|
||
|
int32_t rc;
|
||
|
rc = read(file_i2c, ptr, len);
|
||
|
|
||
|
return 0;
|
||
|
}
|