69 lines
1.0 KiB
C
69 lines
1.0 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;
|
|
|
|
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;
|
|
|
|
read(file_i2c, ptr, len);
|
|
|
|
return 0;
|
|
}
|