accelerometer.h File Reference

Functions
void	initAccelerometer ()

Function Documentation

initAccelerometer()

void initAccelerometer

(

)

Definition at line 222 of file accelerometer.cpp.

                         {
#if HAL_USE_SPI
    static SPIDriver *bus;
    msg_t ret = MSG_RESET;
 
    if (!isBrainPinValid(engineConfiguration->accelerometerCsPin))
        return; // not used
 
    bus = getSpiDevice(engineConfiguration->accelerometerSpiDevice);
    if (bus == nullptr) {
        // error already reported
        return;
    }
 
    /* so far only Hellen boards share SPI device for SD card and accelerometer
     * thus need to make sure CS pin is in a well known proper state */
  if (!accelerometerChipSelect.isInitialized()) {
        accelerometerChipSelect.initPin("SPI Acc", engineConfiguration->accelerometerCsPin);
    }
    accelerometerSpiCfg.ssport = getHwPort("SPI Acc", engineConfiguration->accelerometerCsPin);
    accelerometerSpiCfg.sspad = getHwPin("SPI Acc", engineConfiguration->accelerometerCsPin);
 
    /* Try to detect any of enabled accels */
    /* Hope all device drivers know how to detect correct chip */
#if (EFI_ONBOARD_MEMS_LIS2DW12 == TRUE)
    if (ret != MSG_OK) {
        lis2dw12cfg.spip = bus;
 
        /* LIS2DW12 Object Initialization.*/
        lis2dw12ObjectInit(&LIS2DW12);
 
        /* Activates the LIS2DW12 driver.*/
        ret = lis2dw12Start(&LIS2DW12, &lis2dw12cfg);
        if (ret == MSG_OK) {
            AccelType = ACCEL_LIS2DW12;
        }
    }
#endif //EFI_ONBOARD_MEMS_LIS2DW12 == TRUE
#if (EFI_ONBOARD_MEMS_LIS2DH12 == TRUE)
    if (ret != MSG_OK) {
        lis2dh12cfg.spip = bus;
 
        /* LIS2DH12 Object Initialization.*/
        lsm303agrObjectInit(&LIS2DH12);
 
        /* Activates the LIS2DH12 driver.*/
        ret = lsm303agrStart(&LIS2DH12, &lis2dh12cfg);
        if (ret == MSG_OK) {
            AccelType = ACCEL_LIS2DH12;
        }
    }
#endif //EFI_ONBOARD_MEMS_LIS2DH12 == TRUE
#if (EFI_ONBOARD_MEMS_LIS302DL == TRUE)
    if (ret != MSG_OK) {
        lis302dlcfg.spip = bus;
 
        /* LIS302DL Object Initialization.*/
        lis302dlObjectInit(&LIS302DL);
 
        /* Activates the LIS302DL driver.*/
        ret = lis302dlStart(&LIS302DL, &lis302dlcfg);
        if (ret == MSG_OK) {
            AccelType = ACCEL_LIS302DL;
        }
    }
#endif //EFI_ONBOARD_MEMS_LIS302DL == TRUE
#if (EFI_ONBOARD_MEMS_LIS3DSH == TRUE)
    if (ret != MSG_OK) {
        lis3dshcfg.spip = bus;
 
        /* LIS3DSH Object Initialization.*/
        lis3dshObjectInit(&LIS3DSH);
 
        /* Activates the LIS3DSH driver.*/
        ret = lis3dshStart(&LIS3DSH, &lis3dshcfg);
        if (ret == MSG_OK) {
            AccelType = ACCEL_LIS3DSH;
        }
    }
#endif //EFI_ONBOARD_MEMS_LIS3DSH == TRUE
 
    if (ret == MSG_OK) {
        /* 50 Hz */
        instance.setPeriod(20 /*ms*/);
        instance.start();
        efiPrintf("accelerometer init OK");
    } else {
        efiPrintf("accelerometer init failed %d", (int)ret);
    }
#endif /* HAL_USE_SPI */
}

Referenced by initHardware().

Here is the call graph for this function:

Here is the caller graph for this function:

Go to the source code of this file.