diff --git a/flix/cli.ino b/flix/cli.ino index f414967..9ceb3a2 100644 --- a/flix/cli.ino +++ b/flix/cli.ino @@ -30,8 +30,7 @@ const char* motd = "cr - calibrate RC\n" "cg - calibrate gyro\n" "ca - calibrate accel\n" -"mfr, mfl, mrr, mrl - test appropriate motor\n" -"fullmot - full motor test\n" +"mfr, mfl, mrr, mrl - test motor\n" "reset - reset drone's state\n"; const struct Param { @@ -102,8 +101,6 @@ void doCommand(String& command, String& value) { cliTestMotor(MOTOR_REAR_RIGHT); } else if (command == "mrl") { cliTestMotor(MOTOR_REAR_LEFT); - } else if (command == "fullmot") { - fullMotorTest(value.toInt()); } else if (command == "reset") { attitude = Quaternion(); } else { diff --git a/flix/motors.ino b/flix/motors.ino index d2d14bd..0c17cd1 100644 --- a/flix/motors.ino +++ b/flix/motors.ino @@ -37,14 +37,3 @@ void sendMotors() { ledcWrite(MOTOR_2_PIN, signalToDutyCycle(motors[2])); ledcWrite(MOTOR_3_PIN, signalToDutyCycle(motors[3])); } - -void fullMotorTest(int n) { - printf("Full test for motor %d\n", n); - for (float signal = 0; signal <= 1; signal += 0.1) { - printf("Motor %d: %f\n", n, signal); - ledcWrite(n, signalToDutyCycle(signal)); - delay(3000); - } - printf("Motor %d: %f\n", n, 0); - ledcWrite(n, signalToDutyCycle(0)); -} diff --git a/gazebo/flix.h b/gazebo/flix.h index bc15f94..4c59561 100644 --- a/gazebo/flix.h +++ b/gazebo/flix.h @@ -57,7 +57,6 @@ inline Quaternion FLU2FRD(const Quaternion &q); void setLED(bool on) {}; void calibrateGyro() { printf("Skip gyro calibrating\n"); }; void calibrateAccel() { printf("Skip accel calibrating\n"); }; -void fullMotorTest(int n) { printf("Skip full motor test\n"); }; void sendMotors() {}; void printIMUCal() { printf("cal: N/A\n"); }; void printIMUInfo() {};