ACM: Simplified control mode code
This commit is contained in:
parent
19ae5c30eb
commit
0419dc8dfd
@ -32,14 +32,14 @@ static void read_control_switch()
|
|||||||
}
|
}
|
||||||
|
|
||||||
static byte readSwitch(void){
|
static byte readSwitch(void){
|
||||||
int16_t pulsewidth = g.rc_5.radio_in; // default for Arducopter
|
int16_t pulsewidth = g.rc_5.radio_in; // default for Arducopter
|
||||||
|
|
||||||
if (pulsewidth > 1230 && pulsewidth <= 1360) return 1;
|
if (pulsewidth < 1231) return 0;
|
||||||
if (pulsewidth > 1360 && pulsewidth <= 1490) return 2;
|
if (pulsewidth < 1361) return 1;
|
||||||
if (pulsewidth > 1490 && pulsewidth <= 1620) return 3;
|
if (pulsewidth < 1491) return 2;
|
||||||
if (pulsewidth > 1620 && pulsewidth <= 1749) return 4;
|
if (pulsewidth < 1621) return 3;
|
||||||
if (pulsewidth >= 1750) return 5;
|
if (pulsewidth < 1750) return 4; // Software Manual
|
||||||
return 0;
|
return 5; // Hardware Manual
|
||||||
}
|
}
|
||||||
|
|
||||||
static void reset_control_switch()
|
static void reset_control_switch()
|
||||||
|
Loading…
Reference in New Issue
Block a user