void SchedTest::setup(void) { // we ins.init(AP_InertialSensor::COLD_START, AP_InertialSensor::RATE_50HZ); // initialise the scheduler scheduler.init(&scheduler_tasks[0], ARRAY_SIZE(scheduler_tasks)); }
void setup(void) { serial_manager.init(); ins.init(100); baro.init(); ahrs.init(); gps.init(NULL, serial_manager); }
void setup(void) { ins.init(100); ahrs.init(); serial_manager.init(); if( compass.init() ) { hal.console->printf("Enabling compass\n"); ahrs.set_compass(&compass); } else { hal.console->printf("No compass detected\n"); } gps.init(NULL, serial_manager); }
void setup(void) { hal.console->println("AP_InertialSensor startup..."); #if CONFIG_HAL_BOARD == HAL_BOARD_APM2 || CONFIG_HAL_BOARD == HAL_BOARD_MEGA2560 // we need to stop the barometer from holding the SPI bus hal.gpio->pinMode(40, HAL_GPIO_OUTPUT); hal.gpio->write(40, 1); #endif ins.init(AP_InertialSensor::COLD_START, AP_InertialSensor::RATE_100HZ); // display initial values display_offsets_and_scaling(); hal.console->println("Complete. Reading:"); }
void setup(void) { // setup any board specific drivers BoardConfig.init(); hal.console->printf("AP_InertialSensor startup...\n"); ins.init(100); // display initial values display_offsets_and_scaling(); // display number of detected accels/gyros hal.console->printf("\n"); hal.console->printf("Number of detected accels : %u\n", ins.get_accel_count()); hal.console->printf("Number of detected gyros : %u\n\n", ins.get_gyro_count()); hal.console->printf("Complete. Reading:\n"); }
void setup(void) { #ifdef APM2_HARDWARE // we need to stop the barometer from holding the SPI bus hal.gpio->pinMode(40, HAL_HAL_GPIO_OUTPUT); hal.gpio->write(40, HIGH); #endif ins.init(AP_InertialSensor::RATE_100HZ); ahrs.init(); serial_manager.init(); if( compass.init() ) { hal.console->printf("Enabling compass\n"); ahrs.set_compass(&compass); } else { hal.console->printf("No compass detected\n"); } gps.init(NULL, serial_manager); }