Mirror/GodMode9
1
0
Fork 1
mirror of https://github.com/d0k3/GodMode9.git synced 2025-06-26 13:42:47 +00:00
Code Issues Packages Projects Releases Wiki Activity

Fix I2C delays

Browse Source
This commit is contained in:
d0k3 2017-06-20 00:26:57 +02:00
parent 2861b9516b
commit 27426eae44
1 changed files with 12 additions and 11 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
source/common/i2c.c
View File

@ -1,6 +1,5 @@
#include "i2c.h" #include "i2c.h"
#include "timer.h"
void wait(u64 amount);
//----------------------------------------------------------------------------- //-----------------------------------------------------------------------------
@ -89,15 +88,15 @@ u8 i2cReadRegister(u8 dev_id, u8 reg) {
i2cWaitBusy(bus_id); i2cWaitBusy(bus_id);
i2cStop(bus_id, 1); i2cStop(bus_id, 1);
i2cWaitBusy(bus_id); i2cWaitBusy(bus_id);
wait_msec(3ULL);
return *i2cGetDataReg(bus_id); return *i2cGetDataReg(bus_id);
} }
} }
*i2cGetCntReg(bus_id) = 0xC5; *i2cGetCntReg(bus_id) = 0xC5;
i2cWaitBusy(bus_id); i2cWaitBusy(bus_id);
} }
wait(3ULL); wait_msec(3ULL);
return 0xff; return 0xff;
} }
@ -113,8 +112,10 @@ bool i2cReadRegisterBuffer(unsigned int dev_id, int reg, u8* buffer, size_t buf_
i2cWaitBusy(bus_id); i2cWaitBusy(bus_id);
*i2cGetCntReg(bus_id) = 0xC5; *i2cGetCntReg(bus_id) = 0xC5;
i2cWaitBusy(bus_id); i2cWaitBusy(bus_id);
if (++j >= 8) if (++j >= 8) {
wait_msec(3ULL);
return false; return false;
}
} }
if (buf_size != 1) { if (buf_size != 1) {
@ -131,8 +132,7 @@ bool i2cReadRegisterBuffer(unsigned int dev_id, int reg, u8* buffer, size_t buf_
i2cWaitBusy(bus_id); i2cWaitBusy(bus_id);
buffer[buf_size - 1] = *i2cGetDataReg(bus_id); buffer[buf_size - 1] = *i2cGetDataReg(bus_id);
wait(3ULL); wait_msec(3ULL);
return true; return true;
} }
@ -146,14 +146,15 @@ bool i2cWriteRegister(u8 dev_id, u8 reg, u8 data) {
*i2cGetDataReg(bus_id) = data; *i2cGetDataReg(bus_id) = data;
*i2cGetCntReg(bus_id) = 0xC1; *i2cGetCntReg(bus_id) = 0xC1;
i2cStop(bus_id, 0); i2cStop(bus_id, 0);
if (i2cGetResult(bus_id)) if (i2cGetResult(bus_id)) {
wait_msec(3ULL);
return true; return true;
}
} }
*i2cGetCntReg(bus_id) = 0xC5; *i2cGetCntReg(bus_id) = 0xC5;
i2cWaitBusy(bus_id); i2cWaitBusy(bus_id);
} }
wait(3ULL); wait_msec(3ULL);
return false; return false;
} }