|
|
|
@ -279,66 +279,66 @@ void SpiTestClass::acsInit() {
|
|
|
|
|
#ifdef RASPBERRY_PI
|
|
|
|
|
GpiodRegularByChip *gpio = nullptr;
|
|
|
|
|
std::string rpiGpioName = "gpiochip0";
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm0Lis3mdlChipSelect, "MGM_0_LIS3", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm0Lis3mdlChipSelect, "MGM_0_LIS3", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_0_LIS3_CS, gpio);
|
|
|
|
|
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm1Rm3100ChipSelect, "MGM_1_RM3100", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm1Rm3100ChipSelect, "MGM_1_RM3100", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_1_RM3100_CS, gpio);
|
|
|
|
|
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, gyro0AdisChipSelect, "GYRO_0_ADIS", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, gyro0AdisChipSelect, "GYRO_0_ADIS", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_0_ADIS_CS, gpio);
|
|
|
|
|
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, gyro1L3gd20ChipSelect, "GYRO_1_L3G", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, gyro1L3gd20ChipSelect, "GYRO_1_L3G", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_1_L3G_CS, gpio);
|
|
|
|
|
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, gyro3L3gd20ChipSelect, "GYRO_2_L3G", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, gyro3L3gd20ChipSelect, "GYRO_2_L3G", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_3_L3G_CS, gpio);
|
|
|
|
|
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm2Lis3mdlChipSelect, "MGM_2_LIS3", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm2Lis3mdlChipSelect, "MGM_2_LIS3", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_2_LIS3_CS, gpio);
|
|
|
|
|
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm3Rm3100ChipSelect, "MGM_3_RM3100", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByChip(rpiGpioName, mgm3Rm3100ChipSelect, "MGM_3_RM3100", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_3_RM3100_CS, gpio);
|
|
|
|
|
#elif defined(XIPHOS_Q7S)
|
|
|
|
|
GpiodRegularByLineName *gpio = nullptr;
|
|
|
|
|
gpio =
|
|
|
|
|
new GpiodRegularByLineName(q7s::gpioNames::MGM_0_CS, "MGM_0_LIS3", gpio::OUT, gpio::HIGH);
|
|
|
|
|
new GpiodRegularByLineName(q7s::gpioNames::MGM_0_CS, "MGM_0_LIS3", gpio::DIR_OUT, gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_0_LIS3_CS, gpio);
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_1_CS, "MGM_1_RM3100", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_1_CS, "MGM_1_RM3100", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_1_RM3100_CS, gpio);
|
|
|
|
|
gpio =
|
|
|
|
|
new GpiodRegularByLineName(q7s::gpioNames::MGM_2_CS, "MGM_2_LIS3", gpio::OUT, gpio::HIGH);
|
|
|
|
|
new GpiodRegularByLineName(q7s::gpioNames::MGM_2_CS, "MGM_2_LIS3", gpio::DIR_OUT, gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_2_LIS3_CS, gpio);
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_1_CS, "MGM_3_RM3100", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::MGM_1_CS, "MGM_3_RM3100", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::MGM_3_RM3100_CS, gpio);
|
|
|
|
|
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ADIS_CS, "GYRO_0_ADIS", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ADIS_CS, "GYRO_0_ADIS", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_0_ADIS_CS, gpio);
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_1_L3G_CS, "GYRO_1_L3G", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_1_L3G_CS, "GYRO_1_L3G", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_1_L3G_CS, gpio);
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_2_ADIS_CS, "GYRO_2_ADIS", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_2_ADIS_CS, "GYRO_2_ADIS", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_2_ADIS_CS, gpio);
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_3_L3G_CS, "GYRO_3_L3G", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_3_L3G_CS, "GYRO_3_L3G", gpio::DIR_OUT,
|
|
|
|
|
gpio::HIGH);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_3_L3G_CS, gpio);
|
|
|
|
|
|
|
|
|
|
// Enable pins must be pulled low for regular operations
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ENABLE, "GYRO_0_ENABLE", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ENABLE, "GYRO_0_ENABLE", gpio::DIR_OUT,
|
|
|
|
|
gpio::LOW);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_0_ENABLE, gpio);
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ENABLE, "GYRO_2_ENABLE", gpio::OUT,
|
|
|
|
|
gpio = new GpiodRegularByLineName(q7s::gpioNames::GYRO_0_ENABLE, "GYRO_2_ENABLE", gpio::DIR_OUT,
|
|
|
|
|
gpio::LOW);
|
|
|
|
|
gpioCookie->addGpio(gpioIds::GYRO_2_ENABLE, gpio);
|
|
|
|
|
#endif
|
|
|
|
|