mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-10 18:08:30 -04:00
Better error and defaults checking
This commit is contained in:
parent
2672cac850
commit
288db5c7c5
@ -27,7 +27,7 @@
|
|||||||
V_FRAME
|
V_FRAME
|
||||||
*/
|
*/
|
||||||
|
|
||||||
# define CH7_OPTION CH7_DO_NOTHING
|
# define CH7_OPTION CH7_SAVE_WP
|
||||||
/*
|
/*
|
||||||
CH7_DO_NOTHING
|
CH7_DO_NOTHING
|
||||||
CH7_SET_HOVER
|
CH7_SET_HOVER
|
||||||
|
@ -77,13 +77,15 @@ static struct Location get_cmd_with_index(int i)
|
|||||||
// -------
|
// -------
|
||||||
static void set_command_with_index(struct Location temp, int i)
|
static void set_command_with_index(struct Location temp, int i)
|
||||||
{
|
{
|
||||||
Serial.printf("set_command: %d with id: %d\n", i, temp.id);
|
|
||||||
i = constrain(i, 0, g.command_total.get());
|
i = constrain(i, 0, g.command_total.get());
|
||||||
Serial.printf("set_command: %d with id: %d\n", i, temp.id);
|
//Serial.printf("set_command: %d with id: %d\n", i, temp.id);
|
||||||
|
|
||||||
// store home as 0 altitude!!!
|
// store home as 0 altitude!!!
|
||||||
if (i == 0)
|
// Home is always a MAV_CMD_NAV_WAYPOINT (16)
|
||||||
|
if (i == 0){
|
||||||
temp.alt = 0;
|
temp.alt = 0;
|
||||||
|
temp.id = MAV_CMD_NAV_WAYPOINT;
|
||||||
|
}
|
||||||
|
|
||||||
uint32_t mem = WP_START_BYTE + (i * WP_SIZE);
|
uint32_t mem = WP_START_BYTE + (i * WP_SIZE);
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user