Skip to content

Commit

Permalink
Implemented an initial adapter
Browse files Browse the repository at this point in the history
  • Loading branch information
@thomaschoi143
thomaschoi143 committed Jun 22, 2023
1 parent 4058401 commit d818f7f
Show file tree
Hide file tree
Showing 33 changed files with 1,685 additions and 206 deletions.
263 changes: 111 additions & 152 deletions Drv/LinuxI2cDriver/LinuxI2cDriver.cpp
View file
Original file line number Diff line number Diff line change
Expand Up @@ -10,156 +10,124 @@
//
// ======================================================================

#include "Fw/Types/Assert.hpp"
#include <FpConfig.hpp>
#include <Drv/LinuxI2cDriver/LinuxI2cDriver.hpp>
#include <FpConfig.hpp>
#include <Fw/Logger/Logger.hpp>
#include "Fw/Types/Assert.hpp"

#include <unistd.h> // required for I2C device access
#include <fcntl.h> // required for I2C device configuration
#include <sys/ioctl.h> // required for I2C device usage
#include <linux/i2c.h> // required for struct / constant definitions
#include <linux/i2c-dev.h> // required for constant definitions
#include <fcntl.h> // required for I2C device configuration
#include <linux/i2c-dev.h> // required for constant definitions
#include <linux/i2c.h> // required for struct / constant definitions
#include <sys/ioctl.h> // required for I2C device usage
#include <unistd.h> // required for I2C device access
#include <cerrno>

#define DEBUG_PRINT 0
#define DEBUG_PRINT 1

namespace Drv {

// ----------------------------------------------------------------------
// Construction, initialization, and destruction
// ----------------------------------------------------------------------

LinuxI2cDriver ::
LinuxI2cDriver(
const char *const compName
) : LinuxI2cDriverComponentBase(compName),
m_fd(-1)
{
// ----------------------------------------------------------------------
// Construction, initialization, and destruction
// ----------------------------------------------------------------------

}
LinuxI2cDriver ::LinuxI2cDriver(const char* const compName) : LinuxI2cDriverComponentBase(compName), m_fd(-1) {}

void LinuxI2cDriver ::
init(
const NATIVE_INT_TYPE instance
)
{
void LinuxI2cDriver ::init(const NATIVE_INT_TYPE instance) {
LinuxI2cDriverComponentBase::init(instance);
}
}

LinuxI2cDriver::
~LinuxI2cDriver()
{
if (-1 != this->m_fd) { // check if file is open
::close(this->m_fd);
LinuxI2cDriver::~LinuxI2cDriver() {
if (-1 != this->m_fd) { // check if file is open
::close(this->m_fd);
}
}

bool LinuxI2cDriver::open(const char* device) {
FW_ASSERT(device);
this->m_fd = ::open(device, O_RDWR);
return (-1 != this->m_fd);
}
}

bool LinuxI2cDriver::open(const char* device) {
FW_ASSERT(device);
this->m_fd = ::open(device, O_RDWR);
return (-1 != this->m_fd);
}

// ----------------------------------------------------------------------
// Handler implementations for user-defined typed input ports
// ----------------------------------------------------------------------
// ----------------------------------------------------------------------
// Handler implementations for user-defined typed input ports
// ----------------------------------------------------------------------

// Note this port handler is guarded, so we can make the ioctl call
// Note this port handler is guarded, so we can make the ioctl call

Drv::I2cStatus LinuxI2cDriver ::
write_handler(
const NATIVE_INT_TYPE portNum,
U32 addr,
Fw::Buffer &serBuffer
)
{
// Make sure file has been opened
if (-1 == this->m_fd) {
return I2cStatus::I2C_OPEN_ERR;
}
Drv::I2cStatus LinuxI2cDriver ::write_handler(const NATIVE_INT_TYPE portNum, U32 addr, Fw::Buffer& serBuffer) {
// Make sure file has been opened
if (-1 == this->m_fd) {
return I2cStatus::I2C_OPEN_ERR;
}

#if DEBUG_PRINT
Fw::Logger::logMsg("I2c addr: 0x%02X\n",addr);
for (U32 byte = 0; byte < serBuffer.getSize(); byte++) {
Fw::Logger::logMsg("0x%02X ",serBuffer.getData()[byte]);

}
Fw::Logger::logMsg("\n");
Fw::Logger::logMsg("I2c addr: 0x%02X\n", addr);
for (U32 byte = 0; byte < serBuffer.getSize(); byte++) {
Fw::Logger::logMsg("0x%02X ", serBuffer.getData()[byte]);
}
Fw::Logger::logMsg("\n");
#endif
// select slave address
int stat = ioctl(this->m_fd, I2C_SLAVE, addr);
if (stat == -1) {
// select slave address
int stat = ioctl(this->m_fd, I2C_SLAVE, addr);
if (stat == -1) {
#if DEBUG_PRINT
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
#endif
return I2cStatus::I2C_ADDRESS_ERR;
}
// make sure it isn't a null pointer
FW_ASSERT(serBuffer.getData());
// write data
stat = write(this->m_fd, serBuffer.getData(), serBuffer.getSize());
if (stat == -1) {
return I2cStatus::I2C_ADDRESS_ERR;
}
// make sure it isn't a null pointer
FW_ASSERT(serBuffer.getData());
// write data
stat = write(this->m_fd, serBuffer.getData(), serBuffer.getSize());
if (stat == -1) {
#if DEBUG_PRINT
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
#endif
return I2cStatus::I2C_WRITE_ERR;
}
return I2cStatus::I2C_OK;
}

Drv::I2cStatus LinuxI2cDriver ::
read_handler(
const NATIVE_INT_TYPE portNum,
U32 addr,
Fw::Buffer &serBuffer
)
{
// Make sure file has been opened
if (-1 == this->m_fd) {
return I2cStatus::I2C_OPEN_ERR;
}
return I2cStatus::I2C_WRITE_ERR;
}
return I2cStatus::I2C_OK;
}

Drv::I2cStatus LinuxI2cDriver ::read_handler(const NATIVE_INT_TYPE portNum, U32 addr, Fw::Buffer& serBuffer) {
// Make sure file has been opened
if (-1 == this->m_fd) {
return I2cStatus::I2C_OPEN_ERR;
}

#if DEBUG_PRINT
Fw::Logger::logMsg("I2c addr: 0x%02X\n",addr);
Fw::Logger::logMsg("I2c addr: 0x%02X\n", addr);
#endif
// select slave address
int stat = ioctl(this->m_fd, I2C_SLAVE, addr);
if (stat == -1) {
// select slave address
int stat = ioctl(this->m_fd, I2C_SLAVE, addr);
if (stat == -1) {
#if DEBUG_PRINT
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
#endif
return I2cStatus::I2C_ADDRESS_ERR;
}
// make sure it isn't a null pointer
FW_ASSERT(serBuffer.getData());
// read data
stat = read(this->m_fd, serBuffer.getData(), serBuffer.getSize());
if (stat == -1) {
return I2cStatus::I2C_ADDRESS_ERR;
}
// make sure it isn't a null pointer
FW_ASSERT(serBuffer.getData());
// read data
stat = read(this->m_fd, serBuffer.getData(), serBuffer.getSize());
if (stat == -1) {
#if DEBUG_PRINT
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
#endif
return I2cStatus::I2C_READ_ERR;
}
return I2cStatus::I2C_READ_ERR;
}
#if DEBUG_PRINT
for (U32 byte = 0; byte < serBuffer.getSize(); byte++) {
Fw::Logger::logMsg("0x%02X ",serBuffer.getData()[byte]);

}
Fw::Logger::logMsg("\n");
for (U32 byte = 0; byte < serBuffer.getSize(); byte++) {
Fw::Logger::logMsg("0x%02X ", serBuffer.getData()[byte]);
}
Fw::Logger::logMsg("\n");
#endif
return I2cStatus::I2C_OK;
}

Drv::I2cStatus LinuxI2cDriver ::
writeRead_handler(
const NATIVE_INT_TYPE portNum, /*!< The port number*/
U32 addr,
Fw::Buffer &writeBuffer,
Fw::Buffer &readBuffer
){
return I2cStatus::I2C_OK;
}

Drv::I2cStatus LinuxI2cDriver ::writeRead_handler(const NATIVE_INT_TYPE portNum, /*!< The port number*/
U32 addr,
Fw::Buffer& writeBuffer,
Fw::Buffer& readBuffer) {
// Make sure file has been opened
if (-1 == this->m_fd) {
return I2cStatus::I2C_OPEN_ERR;
Expand All @@ -170,57 +138,48 @@ namespace Drv {
FW_ASSERT(writeBuffer.getData());
FW_ASSERT(readBuffer.getData());

#if DEBUG_PRINT
Fw::Logger::logMsg("I2c addr: 0x%02X\n",addr);
#endif

struct i2c_msg rdwr_msgs[2] = {
{ // Start address
.addr = static_cast<U16>(addr),
.flags = 0, // write
.len = static_cast<U16>(writeBuffer.getSize()),
.buf = writeBuffer.getData()
},
{ // Read buffer
.addr = static_cast<U16>(addr),
.flags = I2C_M_RD, // read
.len = static_cast<U16>(readBuffer.getSize()),
.buf = readBuffer.getData()
}
};

struct i2c_rdwr_ioctl_data rdwr_data = {
.msgs = rdwr_msgs,
.nmsgs = 2
};

//Use ioctl to perform the combined write/read transaction
#if DEBUG_PRINT
Fw::Logger::logMsg("I2c addr: 0x%02X\n", addr);
#endif

struct i2c_msg rdwr_msgs[2] = {{// Start address
.addr = static_cast<U16>(addr),
.flags = 0, // write
.len = static_cast<U16>(writeBuffer.getSize()),
.buf = writeBuffer.getData()},
{// Read buffer
.addr = static_cast<U16>(addr),
.flags = I2C_M_RD, // read
.len = static_cast<U16>(readBuffer.getSize()),
.buf = readBuffer.getData()}};

struct i2c_rdwr_ioctl_data rdwr_data = {.msgs = rdwr_msgs, .nmsgs = 2};

// Use ioctl to perform the combined write/read transaction
NATIVE_INT_TYPE stat = ioctl(this->m_fd, I2C_RDWR, &rdwr_data);

if(stat == -1){
#if DEBUG_PRINT
if (stat == -1) {
#if DEBUG_PRINT
Fw::Logger::logMsg("Status: %d Errno: %d\n", stat, errno);
#endif
//Because we're using ioctl to perform the transaction we dont know exactly the type of error that occurred
return I2cStatus::I2C_OTHER_ERR;
#endif
// Because we're using ioctl to perform the transaction we dont know exactly the type of error that occurred
return I2cStatus::I2C_OTHER_ERR;
}

#if DEBUG_PRINT
Fw::Logger::logMsg("Wrote:\n");
for (U32 byte = 0; byte < writeBuffer.getSize(); byte++) {
Fw::Logger::logMsg("0x%02X ",writeBuffer.getData()[byte]);

Fw::Logger::logMsg("0x%02X ", writeBuffer.getData()[byte]);
}
Fw::Logger::logMsg("\n");
Fw::Logger::logMsg("Read:\n");
for (U32 byte = 0; byte < readBuffer.getSize(); byte++) {
Fw::Logger::logMsg("0x%02X ",readBuffer.getData()[byte]);

Fw::Logger::logMsg("0x%02X ", readBuffer.getData()[byte]);
}
Fw::Logger::logMsg("\n");
#endif

return I2cStatus::I2C_OK;
}
}

} // end namespace Drv
} // end namespace Drv
Loading

0 comments on commit d818f7f

Please sign in to comment.