APMotors6DOF: add case for SIMPLEROV_3

5 years ago · 948a5bf9c3
1 changed files with 3 additions and 0 deletions
--- a/libraries/AP_Motors/AP_Motors6DOF.cpp
+++ b/libraries/AP_Motors/AP_Motors6DOF.cpp
@ -176,6 +176,9 @@ void AP_Motors6DOF::setup_motors(motor_frame_class frame_class, motor_frame_type
				@@ -176,6 +176,9 @@ void AP_Motors6DOF::setup_motors(motor_frame_class frame_class, motor_frame_type
        //break;

    case SUB_FRAME_SIMPLEROV_3:
+        add_motor_raw_6dof(AP_MOTORS_MOT_1,     0,              0,              -1.0f,          0,                  1.0f,               0,              1);
+        add_motor_raw_6dof(AP_MOTORS_MOT_2,     0,              0,              1.0f,           0,                  1.0f,               0,              2);
+        add_motor_raw_6dof(AP_MOTORS_MOT_3,     0,              0,              0,              -1.0f,              0,                  0,              3);
    case SUB_FRAME_SIMPLEROV_4:
    case SUB_FRAME_SIMPLEROV_5:
    default: