Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-25 09:16:01 +03:00
Code Issues Wiki Activity

fix WP MSP regression from #6612

Browse source
This commit is contained in:
Jonathan Hudson 2021-06-26 12:23:46 +01:00
parent 47f2468f0e
commit 9c6bd6a95f
5 changed files with 19 additions and 19 deletions
Download patch file Download diff file Expand all files Collapse all files

2
src/main/fc/cli.c
View file

@ -1387,7 +1387,7 @@ static void cliWaypoints(char *cmdline)
} else if (sl_strcasecmp(cmdline, "reset") == 0) {
resetWaypointList();
} else if (sl_strcasecmp(cmdline, "load") == 0) {
loadNonVolatileWaypointList();
loadNonVolatileWaypointList(true);
} else if (sl_strcasecmp(cmdline, "save") == 0) {
posControl.waypointListValid = false;
for (int i = 0; i < NAV_MAX_WAYPOINTS; i++) {

2
src/main/fc/fc_msp.c
View file

@ -2847,7 +2847,7 @@ static mspResult_e mspFcProcessInCommand(uint16_t cmdMSP, sbuf_t *src)
#ifdef NAV_NON_VOLATILE_WAYPOINT_STORAGE
case MSP_WP_MISSION_LOAD:
sbufReadU8Safe(NULL, src); // Mission ID (reserved)
if ((dataSize != 1) || (!loadNonVolatileWaypointList()))
if ((dataSize != 1) || (!loadNonVolatileWaypointList(false)))
return MSP_RESULT_ERROR;
break;

2
src/main/fc/rc_controls.c
View file

@ -260,7 +260,7 @@ void processRcStickPositions(throttleStatus_e throttleStatus)
// Load waypoint list
if (rcSticks == THR_LO + YAW_CE + PIT_HI + ROL_HI) {
const bool success = loadNonVolatileWaypointList();
const bool success = loadNonVolatileWaypointList(false);
beeper(success ? BEEPER_ACTION_SUCCESS : BEEPER_ACTION_FAIL);
}
#endif

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

@ -2876,13 +2876,13 @@ int getWaypointCount(void)
}
#ifdef NAV_NON_VOLATILE_WAYPOINT_STORAGE
bool loadNonVolatileWaypointList(void)
bool loadNonVolatileWaypointList(bool clearIfLoaded)
{
if (ARMING_FLAG(ARMED))
return false;
// if waypoints are already loaded, just unload them.
if (posControl.waypointCount > 0) {
// if forced and waypoints are already loaded, just unload them.
if (clearIfLoaded && posControl.waypointCount > 0) {
resetWaypointList();
return false;
}

2
src/main/navigation/navigation.h
View file

@ -467,7 +467,7 @@ bool isWaypointListValid(void);
void getWaypoint(uint8_t wpNumber, navWaypoint_t * wpData);
void setWaypoint(uint8_t wpNumber, const navWaypoint_t * wpData);
void resetWaypointList(void);
bool loadNonVolatileWaypointList(void);
bool loadNonVolatileWaypointList(bool);
bool saveNonVolatileWaypointList(void);
float getFinalRTHAltitude(void);