Added build specific sensor initialization.

This commit is contained in:
jwilson
2016-02-19 16:59:49 +01:00
committed by Julian Oes
parent 75fad09263
commit ebfcf32323
4 changed files with 163 additions and 26 deletions
+34 -25
View File
@@ -105,6 +105,9 @@
using namespace DriverFramework;
/* Platform specific sensor initialization function. */
extern int sensors_init(void);
/**
* Analog layout:
* FMU:
@@ -2098,33 +2101,39 @@ Sensors::task_main()
/* start individual sensors */
int ret = 0;
do { /* create a scope to handle exit with break */
#ifndef __PX4_QURT
// TODO: needs fixes for QURT.
ret = accel_init();
if (ret) { break; }
// TODO-JYW: TESTING-TESTING:
ret = sensors_init();
ret = gyro_init();
if (ret) { break; }
ret = mag_init();
if (ret) { break; }
ret = baro_init();
if (ret) { break; }
ret = adc_init();
if (ret) { break; }
#endif
break;
} while (0);
///*
// * QURT devices do not yet use DriverFramework based drivers, which is required for
// * the following initialization sequence to work correctly.
// */
//#ifndef __PX4_QURT
// do { /* create a scope to handle exit with break */
// ret = accel_init();
//
// if (ret) { break; }
//
// ret = gyro_init();
//
// if (ret) { break; }
//
// ret = mag_init();
//
// if (ret) { break; }
//
// ret = baro_init();
//
// if (ret) { break; }
//
// ret = adc_init();
//
// if (ret) { break; }
//
// break;
// } while (0);
//#endif
if (ret) {
warnx("sensor initialization failed");