Use condition variables and mutexes to eliminate sleeps from SMBus threading

This commit is contained in:
Adam Honse 2020-04-30 09:31:01 -05:00
parent bfe03b0564
commit 525071c205
2 changed files with 30 additions and 27 deletions

View file

@ -22,8 +22,6 @@ static void Sleep(unsigned int milliseconds)
i2c_smbus_interface::i2c_smbus_interface()
{
i2c_smbus_done = true;
i2c_smbus_inuse = false;
i2c_smbus_thread = new std::thread(&i2c_smbus_interface::i2c_smbus_thread_function, this);
}
@ -151,13 +149,7 @@ s32 i2c_smbus_interface::i2c_smbus_xfer_call(u8 addr, char read_write, u8 comman
{
s32 ret_val = 0;
printf("i2c smbus xfer call\r\n");
while(i2c_smbus_inuse.load() == true || i2c_smbus_done.load() == false)
{
Sleep(1);
}
i2c_smbus_inuse = true;
i2c_smbus_xfer_mutex.lock();
i2c_addr = addr;
i2c_read_write = read_write;
@ -165,35 +157,37 @@ s32 i2c_smbus_interface::i2c_smbus_xfer_call(u8 addr, char read_write, u8 comman
i2c_size = size;
i2c_data = data;
i2c_smbus_done = false;
std::unique_lock<std::mutex> start_lock(i2c_smbus_start_mutex);
i2c_smbus_start = true;
i2c_smbus_start_cv.notify_all();
start_lock.unlock();
while(i2c_smbus_done.load() == false)
{
Sleep(1);
}
std::unique_lock<std::mutex> done_lock(i2c_smbus_done_mutex);
i2c_smbus_done_cv.wait(done_lock, [this]{ return i2c_smbus_done.load(); });
i2c_smbus_done = false;
ret_val = i2c_ret;
i2c_smbus_inuse = false;
i2c_smbus_xfer_mutex.unlock();
return(i2c_ret);
}
void i2c_smbus_interface::i2c_smbus_thread_function()
{
printf( "i2c thread function start\r\n" );
while(1)
{
while(i2c_smbus_inuse.load() == false || i2c_smbus_done.load() == true)
{
Sleep(1);
}
std::unique_lock<std::mutex> start_lock(i2c_smbus_start_mutex);
printf("i2c xfer: addr %02X R/W %d command %02X size %02X dataptr %X\r\n", i2c_addr, i2c_read_write, i2c_command, i2c_size, i2c_data);
i2c_smbus_start_cv.wait(start_lock, [this]{ return i2c_smbus_start.load(); });
i2c_smbus_start = false;
i2c_ret = i2c_smbus_xfer(i2c_addr, i2c_read_write, i2c_command, i2c_size, i2c_data);
i2c_smbus_done = true;
std::unique_lock<std::mutex> done_lock(i2c_smbus_done_mutex);
i2c_smbus_done = true;
i2c_smbus_done_cv.notify_all();
done_lock.unlock();
}
}
}

View file

@ -11,8 +11,10 @@
#ifndef I2C_SMBUS_H
#define I2C_SMBUS_H
#include <thread>
#include <atomic>
#include <thread>
#include <condition_variable>
#include <mutex>
typedef unsigned char u8;
typedef unsigned short u16;
@ -83,8 +85,15 @@ public:
private:
std::thread * i2c_smbus_thread;
std::atomic<bool> i2c_smbus_done;
std::atomic<bool> i2c_smbus_inuse;
std::atomic<bool> i2c_smbus_start;
std::condition_variable i2c_smbus_start_cv;
std::mutex i2c_smbus_start_mutex;
std::atomic<bool> i2c_smbus_done;
std::condition_variable i2c_smbus_done_cv;
std::mutex i2c_smbus_done_mutex;
std::mutex i2c_smbus_xfer_mutex;
u8 i2c_addr;
char i2c_read_write;