|
|
@ -547,6 +547,14 @@ void AP_MotorsMatrix::setup_motors(motor_frame_class frame_class, motor_frame_ty |
|
|
|
add_motor(AP_MOTORS_MOT_4, 0, 160, AP_MOTORS_MATRIX_YAW_FACTOR_CW, 2); |
|
|
|
add_motor(AP_MOTORS_MOT_4, 0, 160, AP_MOTORS_MATRIX_YAW_FACTOR_CW, 2); |
|
|
|
success = true; |
|
|
|
success = true; |
|
|
|
break; |
|
|
|
break; |
|
|
|
|
|
|
|
case MOTOR_FRAME_TYPE_PLUSREV: |
|
|
|
|
|
|
|
// plus with reversed motor directions
|
|
|
|
|
|
|
|
add_motor(AP_MOTORS_MOT_1, 90, AP_MOTORS_MATRIX_YAW_FACTOR_CW, 2); |
|
|
|
|
|
|
|
add_motor(AP_MOTORS_MOT_2, -90, AP_MOTORS_MATRIX_YAW_FACTOR_CW, 4); |
|
|
|
|
|
|
|
add_motor(AP_MOTORS_MOT_3, 0, AP_MOTORS_MATRIX_YAW_FACTOR_CCW,1); |
|
|
|
|
|
|
|
add_motor(AP_MOTORS_MOT_4, 180, AP_MOTORS_MATRIX_YAW_FACTOR_CCW,3); |
|
|
|
|
|
|
|
success = true; |
|
|
|
|
|
|
|
break; |
|
|
|
default: |
|
|
|
default: |
|
|
|
// quad frame class does not support this frame type
|
|
|
|
// quad frame class does not support this frame type
|
|
|
|
break; |
|
|
|
break; |
|
|
|