rooty/LibrePilot
1
0
Fork 0
mirror of https://bitbucket.org/librepilot/librepilot.git synced 2025-01-17 02:52:12 +01:00
Code Issues Releases Activity

IMU3000: Sometimes the irq is called before previous I2C transaction. This

Browse Source 
isn't good but for now just deal with it.  Need DMA I2C driver.
This commit is contained in:
James Cotton 2011-08-22 02:34:40 -05:00
parent 8c16f614f2
commit 4e59e697af
1 changed files with 7 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
flight/PiOS/STM32F2xx/pios_imu3000.c
View File

@ -328,6 +328,7 @@ uint32_t imu3000_irq = 0;
uint16_t fifo_level;
uint8_t fifo_level_data[2];
uint32_t imu3000_readtime;
uint32_t cb_not_ready = 0;
void PIOS_IMU3000_IRQHandler(void)
{
@ -336,7 +337,12 @@ void PIOS_IMU3000_IRQHandler(void)
if(!imu3000_configured)
return;
PIOS_Assert(imu3000_cb_ready);
//PIOS_Assert(imu3000_cb_ready);
if(!imu3000_cb_ready) {
PIOS_LED_Toggle(LED2);
cb_not_ready++;
return;
}
// If at least one read doesnt succeed then the irq not reset and we will stall
while(PIOS_IMU3000_Read(PIOS_IMU3000_FIFO_CNT_MSB, (uint8_t *) &fifo_level_data, sizeof(fifo_level_data)) != 0)