Cleanups and minor changes

This commit is contained in:
Oleg Kalachev
2023-11-11 06:17:50 +03:00
parent c4ac5eb9d0
commit 8df71b078d
2 changed files with 7 additions and 9 deletions

View File

@@ -56,13 +56,11 @@ void control()
interpretRC();
if (mode == STAB) {
controlAttitude();
// controlAttitudeAlter();
}
if (mode == MANUAL) {
controlManual();
} else {
controlRate();
} else if (mode == ACRO) {
controlRate();
} else if (mode == MANUAL) {
controlManual();
}
}
@@ -77,7 +75,7 @@ void interpretRC()
mode = STAB;
}
armed = controls[RC_CHANNEL_THROTTLE] >= 0.1 && controls[RC_CHANNEL_AUX] >= 0.5;
armed = controls[RC_CHANNEL_THROTTLE] >= 0.05 && controls[RC_CHANNEL_AUX] >= 0.5;
controlYaw = armed && mode == STAB && controls[RC_CHANNEL_YAW] == 0;
if (!controlYaw) {