Private
Public Access
2
0

ftdi_ft4222: Added mutex synchronize i2c operations

Signed-off-by: Henry Bruce <henry.bruce@intel.com>
This commit is contained in:
Henry Bruce
2016-02-11 13:05:33 -08:00
committed by Brendan Le Foll
parent 839bdb9011
commit 944670f66a

View File

@@ -42,6 +42,7 @@
#define GPIO_PORT_IO_RESET GPIO_PORT2
#define GPIO_PORT_IO_INT GPIO_PORT3
static pthread_mutex_t ft4222_lock;
static FT_HANDLE ftHandleGpio = (FT_HANDLE) NULL; //GPIO Handle
static FT_HANDLE ftHandleI2c = (FT_HANDLE) NULL; //I2C/SPI Handle
static FT_HANDLE ftHandleSpi = (FT_HANDLE) NULL; //I2C/SPI Handle
@@ -53,6 +54,7 @@ static int numI2cSwitchBusses = 4;
static int currentI2cBus = 0;
static void
mraa_ftdi_ft4222_sleep_ms(unsigned long mseconds)
{
@@ -211,16 +213,19 @@ mraa_ftdi_ft4222_i2c_read_internal(FT_HANDLE handle, uint8_t addr, uint8_t* data
{
uint16 bytesRead = 0;
uint8 controllerStatus;
syslog(LOG_NOTICE, "FT4222_I2CMaster_Read(%#02X, %#02X)", addr, length);
// syslog(LOG_NOTICE, "FT4222_I2CMaster_Read(%#02X, %#02X)", addr, length);
mraa_ftdi_ft4222_sleep_ms(1);
pthread_mutex_lock(&ft4222_lock);
FT4222_STATUS ft4222Status = FT4222_I2CMaster_Read(handle, addr, data, length, &bytesRead);
ft4222Status = FT4222_I2CMaster_GetStatus(ftHandleI2c, &controllerStatus);
if (FT4222_OK != ft4222Status || I2CM_ERROR(controllerStatus)) {
syslog(LOG_ERR, "FT4222_I2CMaster_Read failed for address %#02x\n", addr);
FT4222_I2CMaster_Reset(handle);
pthread_mutex_unlock(&ft4222_lock);
return 0;
}
syslog(LOG_NOTICE, "FT4222_I2CMaster_Read completed");
// syslog(LOG_NOTICE, "FT4222_I2CMaster_Read completed");
pthread_mutex_unlock(&ft4222_lock);
return bytesRead;
}
@@ -229,15 +234,17 @@ mraa_ftdi_ft4222_i2c_write_internal(FT_HANDLE handle, uint8_t addr, const uint8_
{
uint16 bytesWritten = 0;
uint8 controllerStatus;
syslog(LOG_NOTICE, "FT4222_I2CMaster_Write(%#02X, %#02X, %d)", addr, *data, bytesToWrite);
// syslog(LOG_NOTICE, "FT4222_I2CMaster_Write(%#02X, %#02X, %d)", addr, *data, bytesToWrite);
pthread_mutex_lock(&ft4222_lock);
FT4222_STATUS ft4222Status = FT4222_I2CMaster_Write(handle, addr, (uint8_t*) data, bytesToWrite, &bytesWritten);
ft4222Status = FT4222_I2CMaster_GetStatus(ftHandleI2c, &controllerStatus);
if (FT4222_OK != ft4222Status || I2CM_ERROR(controllerStatus)) {
syslog(LOG_ERR, "FT4222_I2CMaster_Write failed address %#02x\n", addr);
FT4222_I2CMaster_Reset(handle);
pthread_mutex_unlock(&ft4222_lock);
return 0;
}
pthread_mutex_unlock(&ft4222_lock);
if (bytesWritten != bytesToWrite)
syslog(LOG_ERR, "FT4222_I2CMaster_Write wrote %u of %u bytes.\n", bytesWritten, bytesToWrite);
@@ -794,6 +801,11 @@ mraa_ftdi_ft4222()
mraa_ftdi_ft4222_populate_gpio_func_table(func_table);
sub_plat->adv_func = func_table;
if (pthread_mutex_init(&ft4222_lock, NULL) != 0) {
syslog(LOG_ERR, "Could not create mutex for FT4222 access");
return NULL;
}
return sub_plat;
}