HR/EMS20_handshake
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Corrected spelling mistakes. Cannot transmit I2C

Browse Source
This commit is contained in:
Bram_0971472 2020-10-15 11:08:14 +02:00
parent 7d5bd14503
commit 24ccf86b7c
1 changed files with 13 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

19
src/gsensor.c
View File

@ -25,13 +25,14 @@ void * GSensorTask(void *args) {
I2C_Handle speedyBoy; I2C_Handle speedyBoy;
speedyBoy = I2C_Open(0, NULL); speedyBoy = I2C_open(0, NULL);
// buffer create // buffer create
int8_t buffer_rcv; int8_t buffer_rcv;
uint8_t buffer_send = ACCD_X_MSB; uint8_t buffer_send = ACCD_X_MSB;
double timer = 0; double timer = 0;
int sleeper;
I2C_Transaction RW_Trans; I2C_Transaction RW_Trans;
RW_Trans.slaveAddress = SPEEDYBOI_ADDR; RW_Trans.slaveAddress = SPEEDYBOI_ADDR;
@ -41,18 +42,24 @@ void * GSensorTask(void *args) {
RW_Trans.readCount = 1; RW_Trans.readCount = 1;
while(1) { while(1) {
I2C_transfer(speedyBoy, &RW_Trans); bool success = I2C_transfer(speedyBoy, &RW_Trans);
if (success == false) {
while(1); // als een connectie niet kan worden gemaakt, blijf hier.w
}
// publish read into mailbox (defined in mqtt.c) // publish read into mailbox (defined in mqtt.c)
timer++; timer++;
sleeper = 6000000;
pakketje pakket; pakketje pakket;
pakket.richting = (buffer_rcv < 0) ? Achteruit : Vooruit; pakket.richting = (buffer_rcv < 0) ? Achteruit : Vooruit;
pakket.timestmp = timer; pakket.timestamp = timer;
pakket.g = abs(buffer_rsv); pakket.g = abs(buffer_rcv);
MQTTPublish(pakket); // MQTTPublish(pakket);
usleep(100000U); while(sleeper) {
sleeper--;
}
} }
return 0; return 0;