// stability_test void motor_order_test() { hal.console->println("testing motor order"); motors.armed(true); for (int8_t i=1; i <= AP_MOTORS_MAX_NUM_MOTORS; i++) { hal.console->printf("Motor %d\n",(int)i); motors.output_test(i, 1150); hal.scheduler->delay(300); motors.output_test(i, 1000); hal.scheduler->delay(2000); } motors.armed(false); hal.console->println("finished test."); }
// stability_test void motor_order_test() { motors.armed(true); for (int8_t i=1; i <= 4; i++) { hal.console->printf("Motor %d\n",(int)i); int elapsed =0,stop; int start = hal.scheduler->micros(); //Time Test motors.output_test(i, 1150); stop = hal.scheduler->micros(); elapsed = stop - start; hal.console->printf(" Elapsed Time: %dus\n",elapsed); hal.scheduler->delay(300); motors.output_test(i, 1000); hal.scheduler->delay(2000); } motors.armed(false); hal.console->printf("\n\n"); }