yorick.geoffre
/
thermi2c
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

working read

Browse Source
master
Yorick GEOFFRE 2 years ago
parent 351d6cdd50
commit f91e5cee95
4 changed files with 99 additions and 122 deletions
Show Stats Download Patch File Download Diff File

3
src/MLX90640_API.cpp
Unescape View File

@ -20,8 +20,7 @@
int MLX90640::mlx90640_DumpEE(uint8_t slaveAddr, uint16_t *eeData)
{
//return mlx90640_I2CRead(slaveAddr, mlx90640_EEPROM_START_ADDRESS, mlx90640_EEPROM_DUMP_NUM, eeData);
return mlx90640_I2CRead(slaveAddr, 0x00, 1300, eeData);
return mlx90640_I2CRead(slaveAddr, mlx90640_EEPROM_START_ADDRESS, mlx90640_EEPROM_DUMP_NUM, eeData);
}
int MLX90640::mlx90640_SynchFrame(uint8_t slaveAddr)

11
src/MLX90640_API.h
Unescape View File

@ -149,12 +149,15 @@ public:
int status;
status = mlx90640_DumpEE (slaveAddress, eeMLX90640);
//status = mlx90640_ExtractParameters(eeMLX90640, &mlx90640);
//status = mlx90640_GetFrameData (0x33, mlx90640Frame);
//mlx90640_GetImage(mlx90640Frame, &mlx90640);
status = mlx90640_ExtractParameters(eeMLX90640, &mlx90640);
status = mlx90640_GetFrameData (0x33, mlx90640Frame);
mlx90640_GetImage(mlx90640Frame, &mlx90640);
for (int i = 0; i < 834; ++i) {
imageVect[i] = mlx90640Frame[i];
}
}
MLX90640() : imageVect(768){}
MLX90640() : imageVect(834){}
QVector<float> imageVect;
protected:

2
src/MLX90640_I2C_Driver.cpp
Unescape View File

@ -17,7 +17,7 @@ void mlx90640_I2CInit(void){
/// \return 0 if success
///
int mlx90640_I2CGeneralReset(void){
return 0;
}
///

205
src/i2cif.cpp
Unescape View File

@ -14,6 +14,11 @@
#include "conv.h"
#include <unistd.h>
#include <errno.h>
#include <stdint.h>
#include <iostream>
#include <iomanip>
#include <netinet/in.h>
#define DEFAULT_I2C_DEV QString("/dev/i2c-1/")
I2cif::I2cif(QObject *parent) :
@ -149,19 +154,88 @@ Q_INVOKABLE void I2cif::i2cWrite(const uint8_t &slaveAddr, const uint16_t &write
void I2cif::i2cRead(const uint8_t &slaveAddr, const uint16_t &startAddress, const uint16_t &nMemAddressRead, uint16_t *data)
{
int file;
char buf[2];
Conv conv;
m_readResult = QString();
const char* devNameChar = "/dev/i2c-1";
fprintf(stderr, "reading from address %02x count %d\n", slaveAddr, nMemAddressRead);
if ((file = open (devNameChar, O_RDWR)) < 0)
{
fprintf(stderr,"open error\n");
emit i2cError();
return;
}
struct i2c_rdwr_ioctl_data i2c_data;
struct i2c_msg msg[2];
__u8 regAddrBytes[2] = {0,0};
regAddrBytes[0] = (startAddress >> 8) & 0xFF; // High byte
regAddrBytes[1] = startAddress & 0xFF; // Low byte
i2c_data.msgs = msg;
i2c_data.nmsgs = 2;
i2c_data.msgs[0].addr = slaveAddr;
i2c_data.msgs[0].flags = 0;
i2c_data.msgs[0].len = 2;
i2c_data.msgs[0].buf = regAddrBytes;
i2c_data.msgs[1].addr = slaveAddr;
i2c_data.msgs[1].flags = I2C_M_RD;
i2c_data.msgs[1].len = nMemAddressRead;
i2c_data.msgs[1].buf = (__u8 *)data;
int ret = ioctl(file, I2C_RDWR, &i2c_data);
if (ret < 0)
{
fprintf(stderr, "read data fail %d\n", ret);
emit i2cError();
return;
}
close(file);
fprintf(stderr, "read ");
for (int i=0; i<nMemAddressRead ; i++)
{
data[i] = htons(data[i]);
m_readResult = m_readResult + conv.toHex(data[i],2) + " ";
fprintf(stderr, "%02x ", data[i]);
}
fprintf(stderr, "\n");
emit i2cReadResultChanged();
}
/*
* I2C Read function
*
*/
void I2cif::i2cRead(QString devName, unsigned char address, int count)
{
int file;
char buf[200];
Conv conv;
m_readResult = "";
//emit i2cReadResultChanged();
QByteArray tmpBa = devName.toUtf8();
const char* devNameChar = tmpBa.constData();
fprintf(stderr, "reading from address %02x count %d\n", address, count);
if ((file = open (devNameChar, O_RDWR)) < 0)
{
fprintf(stderr,"open error %d, %s\n",errno, devNameChar);
fprintf(stderr,"open error\n");
emit i2cError();
return;
}
if (ioctl(file, I2C_SLAVE, slaveAddr) < 0)
if (ioctl(file, I2C_SLAVE, address) < 0)
{
close(file);
fprintf(stderr,"ioctl error\n");
@ -170,41 +244,30 @@ void I2cif::i2cRead(const uint8_t &slaveAddr, const uint16_t &startAddress, cons
}
/* Read data */
for (int i = 0; i < nMemAddressRead; i++)
if (read( file, buf, count ) != count)
{
/* Write start address */
buf[0] = ((startAddress + i) >> 8) & 0xFF; // startAddress high byte
buf[1] = (startAddress + i) & 0xFF; // startAddress low byte
if (write(file, buf, sizeof(buf)) != sizeof(buf))
{
close(file);
fprintf(stderr,"write error\n");
emit i2cError();
return;
}
if (read(file, buf, sizeof(buf)) != sizeof(buf))
{
close(file);
fprintf(stderr,"read error\n");
emit i2cError();
return;
}
data[i] = ((uint16_t)buf[0] << 8) | buf[1]; // Combine high and low bytes into a 16-bit data
close(file);
fprintf(stderr,"read error\n");
emit i2cError();
return;
}
close(file);
/* copy buf to m_readResult */
int i;
fprintf(stderr, "read ");
for (int i = 0; i < nMemAddressRead; i++)
for (i=0; i<count ; i++)
{
fprintf(stderr, "%04x ", data[i]);
m_readResult = m_readResult + conv.toHex(buf[i],2) + " ";
fprintf(stderr, "%02x ", buf[i]);
}
fprintf(stderr, "\n");
emit i2cReadResultChanged();
}
//--------------------------------------------------------------------------------
void I2cif::i2cWrite(QString devName, unsigned char address, QString data)
{
int file;
@ -266,95 +329,7 @@ void I2cif::i2cWrite(QString devName, unsigned char address, QString data)
}
/*
* I2C Read function
*
*/
void I2cif::i2cRead(QString devName, unsigned char address, int count)
{
int file;
const int CHUNK_SIZE = 200;
char buf[CHUNK_SIZE];
Conv conv;
int bytesRead = 0;
const int MAX_ATTEMPTS = 3;
int attempt = 0;
m_readResult = "";
QByteArray tmpBa = devName.toUtf8();
const char* devNameChar = tmpBa.constData();
fprintf(stderr, "reading from address %02x count %d\n", address, count);
do
{
if ((file = open (devNameChar, O_RDWR)) < 0)
{
perror("open");
if (errno == EBUSY)
{
fprintf(stderr, "i2c bus is busy!\n");
usleep(50000); // wait for 50 ms
continue;
}else{
fprintf(stderr, "got error: %d\n", errno);
}
emit i2cError();
return;
}
break;
} while (++attempt < MAX_ATTEMPTS);
if (attempt == MAX_ATTEMPTS)
{
fprintf(stderr, "Failed to open the device after %d attempts\n", attempt);
emit i2cError();
return;
}
if (ioctl(file, I2C_SLAVE, address) < 0)
{
close(file);
perror("ioctl");
emit i2cError();
return;
}
while(bytesRead < count)
{
int chunk = count - bytesRead;
if(chunk > CHUNK_SIZE)
{
chunk = CHUNK_SIZE;
}
/* Read data */
if (read( file, buf, chunk ) != chunk)
{
close(file);
perror("read");
emit i2cError();
return;
}
/* copy buf to m_readResult */
fprintf(stderr, "read ");
for (int i=0; i<chunk ; i++)
{
m_readResult = m_readResult + conv.toHex(buf[i],2) + " ";
fprintf(stderr, "%02x ", buf[i]);
}
fprintf(stderr, "\n");
bytesRead += chunk;
}
close(file);
emit i2cReadResultChanged();
}
/*
* I2C write then read with repeated stop
*/

Write Preview
Loading…
Cancel
Save