APMotors6DOF: add case for SIMPLEROV_3

This commit is contained in:
Willian Galvani 2019-09-17 15:41:03 -03:00 committed by Andrew Tridgell
parent 28c2179a97
commit f5ba04d098
1 changed files with 3 additions and 0 deletions

View File

@ -176,6 +176,9 @@ void AP_Motors6DOF::setup_motors(motor_frame_class frame_class, motor_frame_type
//break; //break;
case SUB_FRAME_SIMPLEROV_3: 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_4:
case SUB_FRAME_SIMPLEROV_5: case SUB_FRAME_SIMPLEROV_5:
default: default: