|
|
@ -168,7 +168,6 @@ static void output_motor_test() |
|
|
|
motor_out[MOT_6] = g.rc_3.radio_min; |
|
|
|
motor_out[MOT_6] = g.rc_3.radio_min; |
|
|
|
|
|
|
|
|
|
|
|
if(g.frame_orientation == X_FRAME){ |
|
|
|
if(g.frame_orientation == X_FRAME){ |
|
|
|
|
|
|
|
|
|
|
|
APM_RC.OutputCh(MOT_3, g.rc_3.radio_min); |
|
|
|
APM_RC.OutputCh(MOT_3, g.rc_3.radio_min); |
|
|
|
delay(4000); |
|
|
|
delay(4000); |
|
|
|
APM_RC.OutputCh(MOT_5, g.rc_3.radio_min + 100); |
|
|
|
APM_RC.OutputCh(MOT_5, g.rc_3.radio_min + 100); |
|
|
@ -199,10 +198,7 @@ static void output_motor_test() |
|
|
|
APM_RC.OutputCh(MOT_3, g.rc_3.radio_min + 100); |
|
|
|
APM_RC.OutputCh(MOT_3, g.rc_3.radio_min + 100); |
|
|
|
delay(300); |
|
|
|
delay(300); |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
} else { /* PLUS_FRAME */ |
|
|
|
} else { /* PLUS_FRAME */ |
|
|
|
|
|
|
|
|
|
|
|
APM_RC.OutputCh(MOT_5, g.rc_3.radio_min); |
|
|
|
APM_RC.OutputCh(MOT_5, g.rc_3.radio_min); |
|
|
|
delay(4000); |
|
|
|
delay(4000); |
|
|
|
APM_RC.OutputCh(MOT_1, g.rc_3.radio_min + 100); |
|
|
|
APM_RC.OutputCh(MOT_1, g.rc_3.radio_min + 100); |
|
|
@ -234,8 +230,6 @@ static void output_motor_test() |
|
|
|
delay(300); |
|
|
|
delay(300); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
APM_RC.OutputCh(MOT_1, motor_out[MOT_1]); |
|
|
|
APM_RC.OutputCh(MOT_1, motor_out[MOT_1]); |
|
|
|
APM_RC.OutputCh(MOT_2, motor_out[MOT_2]); |
|
|
|
APM_RC.OutputCh(MOT_2, motor_out[MOT_2]); |
|
|
|
APM_RC.OutputCh(MOT_3, motor_out[MOT_3]); |
|
|
|
APM_RC.OutputCh(MOT_3, motor_out[MOT_3]); |
|
|
|