Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-23 08:15:26 +03:00
Code Issues Wiki Activity

Detect braking in cruise mode

Browse source
This commit is contained in:
Pawel Spychalski (DzikuVx) 2018-05-04 14:18:53 +02:00
parent 4d5cc76fbb
commit 4400c0af0f
2 changed files with 38 additions and 1 deletions
Download patch file Download diff file Expand all files Collapse all files

33
src/main/navigation/navigation.c
View file

@ -1962,6 +1962,39 @@ static bool adjustPositionFromRCInput(void)
retValue = adjustFixedWingPositionFromRCInput();
}
else {
/*
* Process states
*/
if (navConfig()->general.flags.user_control_mode == NAV_GPS_CRUISE) {
const int16_t rcPitchAdjustment = applyDeadband(rcCommand[PITCH], rcControlsConfig()->pos_hold_deadband);
const int16_t rcRollAdjustment = applyDeadband(rcCommand[ROLL], rcControlsConfig()->pos_hold_deadband);
/*
* Case one, when we order to brake (sticks to the center) and we are moving above threshold
* Speed is above 1m/s and sticks are centered
*/
if (!STATE(NAV_CRUISE_BRAKING) &&
posControl.actualState.velXY > 100.0f &&
!rcPitchAdjustment &&
!rcRollAdjustment
) {
ENABLE_STATE(NAV_CRUISE_BRAKING);
}
/*
* Case when we were braking but copter finally stopped or we started to move the sticks
*/
if (STATE(NAV_CRUISE_BRAKING) && (
posControl.actualState.velXY <= 100.0f ||
rcPitchAdjustment ||
rcRollAdjustment
)) {
DISABLE_STATE(NAV_CRUISE_BRAKING);
}
}
retValue = adjustMulticopterPositionFromRCInput();
}