From f5ba04d098b6ff11d3a89a466d498940a496768e Mon Sep 17 00:00:00 2001 From: Willian Galvani Date: Tue, 17 Sep 2019 15:41:03 -0300 Subject: [PATCH] APMotors6DOF: add case for SIMPLEROV_3 --- libraries/AP_Motors/AP_Motors6DOF.cpp | 3 +++ 1 file changed, 3 insertions(+) diff --git a/libraries/AP_Motors/AP_Motors6DOF.cpp b/libraries/AP_Motors/AP_Motors6DOF.cpp index 386e7d1c70..ca82fdba11 100644 --- 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 //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: