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

Attempting to get flash and BMA180 to coexist

Browse Source
This commit is contained in:
James Cotton 2012-01-20 13:33:21 -06:00
parent 1e8811362e
commit 7f284596f2
2 changed files with 21 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

35
flight/PiOS/STM32F4xx/pios_bma180.c
View File

@ -73,7 +73,9 @@ int32_t PIOS_BMA180_Init(const struct pios_bma180_cfg * cfg)
if(PIOS_BMA180_Config() < 0)
return -1;
PIOS_DELAY_WaituS(50);
PIOS_BMA180_EnableIrq();
while(PIOS_BMA180_EnableIrq() != 0);
return 0;
}
@ -175,21 +177,14 @@ static int32_t PIOS_BMA180_Config()
PIOS_DELAY_WaituS(20);
if(PIOS_BMA180_EnableEeprom() < 0)
return -1;
if(PIOS_BMA180_SetReg(BMA_RESET, BMA_RESET_CODE) < 0)
return -1;
if(PIOS_BMA180_SetReg(BMA_OFFSET_LSB1, 0x81) < 0)
return -1;
if(PIOS_BMA180_SetReg(BMA_GAIN_Y, 0x81) < 0)
return -1;
if(PIOS_BMA180_SetReg(BMA_CTRREG3, 0xFF) < 0)
return -1;
PIOS_BMA180_SelectBW(BMA_BW_600HZ);
PIOS_BMA180_SetRange(BMA_RANGE_8G);
if(PIOS_BMA180_DisableEeprom() < 0)
return -1;
while(PIOS_BMA180_EnableEeprom() != 0);
while(PIOS_BMA180_SetReg(BMA_RESET, BMA_RESET_CODE) != 0);
while(PIOS_BMA180_SetReg(BMA_OFFSET_LSB1, 0x81) != 0);
while(PIOS_BMA180_SetReg(BMA_GAIN_Y, 0x81) != 0);
while(PIOS_BMA180_SetReg(BMA_CTRREG3, 0xFF) != 0);
while(PIOS_BMA180_SelectBW(BMA_BW_600HZ) != 0);
while(PIOS_BMA180_SetRange(BMA_RANGE_8G) != 0);
while(PIOS_BMA180_DisableEeprom() != 0);
return 0;
}
@ -326,6 +321,8 @@ int32_t PIOS_BMA180_ReadFifo(struct pios_bma180_data * buffer)
*/
int32_t PIOS_BMA180_Test()
{
return 0;
// Read chip ID then version ID
uint8_t buf[3] = {0x80 | BMA_CHIPID_ADDR, 0, 0};
uint8_t rec[3] = {0,0, 0};
@ -390,8 +387,9 @@ const static uint8_t pios_bma180_req_buf[7] = {BMA_X_LSB_ADDR | 0x80,0,0,0,0,0};
static void PIOS_BMA180_IRQHandler(void)
{
// If we can't get the bus then just move on for efficiency
if(PIOS_BMA180_ClaimBus() != 0)
if(PIOS_BMA180_ClaimBus() != 0) {
return; // Something else is using bus, miss this data
}
PIOS_SPI_TransferBlock(PIOS_SPI_ACCEL,pios_bma180_req_buf,(uint8_t *) pios_bma180_dmabuf,
sizeof(pios_bma180_dmabuf), NULL);
@ -404,9 +402,12 @@ static void PIOS_BMA180_IRQHandler(void)
* Soon this will be generic in pios_exti and the BMA180 will register
* against it
*/
int32_t bma180_irq = 0;
void EXTI4_IRQHandler(void)
{
if (EXTI_GetITStatus(dev_cfg->eoc_exti.init.EXTI_Line) != RESET) {
bma180_irq++;
PIOS_BMA180_IRQHandler();
EXTI_ClearITPendingBit(dev_cfg->eoc_exti.init.EXTI_Line);
}

5
flight/Revolution/System/pios_board.c
View File

@ -1562,6 +1562,9 @@ void PIOS_Board_Init(void) {
PIOS_DEBUG_Assert(0);
}
PIOS_BMA180_Attach(pios_spi_accel_id);
PIOS_BMA180_Init(&pios_bma180_cfg);
/* Set up the SPI interface to the gyro */
if (PIOS_SPI_Init(&pios_spi_gyro_id, &pios_spi_gyro_cfg)) {
PIOS_DEBUG_Assert(0);
@ -1732,8 +1735,6 @@ void PIOS_Board_Init(void) {
PIOS_Assert(0);
#endif
PIOS_BMA180_Attach(pios_spi_accel_id);
PIOS_BMA180_Init(&pios_bma180_cfg);
PIOS_HMC5883_Init(&pios_hmc5883_cfg);