Daniel Agar
d0c9a5fc93
OFFBOARD mode architecture overhaul ( #16739 )
...
- handle SET_POSITION_TARGET_LOCAL_NED and SET_POSITION_TARGET_GLOBAL_INT with ORB_ID(trajectory_setpoint)
- FlightTaskOffboard not needed at all
- bypass position_setpoint_triplet entirely (start removing extraneous fields)
- simplify offboard_control_mode to map to supported control modes
2021-03-05 09:39:46 -05:00
Daniel Agar
94bcda7c57
navigator: poll mission to run feasibility checks immediately
2021-02-26 10:28:49 +01:00
David Jablonski
ed7a5314d8
rtl: head towards home location after descend
2021-02-22 16:37:08 +01:00
David Jablonski
aeccb621c5
rtl: added loiter radius for descending
2021-02-22 16:37:08 +01:00
Silvan Fuhrer
0ea8104344
select single system-wide wind estimate message (current best)
...
- publish wind estimate only from EKF, and wind speeds from airspeed selector to new separate topic (airspeed_wind)
- rename message wind_estimate to wind
- publish wind from currently used ekf instance (ekf2selector)
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-02-20 13:15:01 -05:00
Julian Oes
e6b1775bb6
vmount/navigator/mavlink: gimbal v2 changes
...
This is a collection of commits all having to do with changes in the
Mavlink gimbal v2 protocol as described in:
https://mavlink.io/en/services/gimbal_v2.html
2021-02-17 13:54:34 -05:00
Lorenz Meier
8d78b8a01d
Change wording in GPS failure handling
...
This matches better the different platforms that are using this functionality.
2021-02-14 11:17:28 +01:00
Daniel Agar
ce552a3364
navigator: RTL don't get invalid params
2021-02-13 00:34:56 +01:00
Daniel Agar
f61d8539cb
fw_pos_control_l1: add takeoff minimum pitch parameter
...
- remove mavlink mechanism for setting minimum pitch
2021-02-12 13:57:15 -05:00
Silvan Fuhrer
b9b9c55325
Navigator: change default of GF_ACTION to 2 (Hold)
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-02-01 11:07:53 +01:00
Silvan Fuhrer
85d8e74609
Navigator: yaw error from param and pos_ctl_status.acceptence_rad checks before using
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-29 19:36:59 +01:00
Silvan Fuhrer
4d6749edc2
mission_block: change loiter handling logic
...
- add ability of "heading wait" for NAV_CMD_LOITER_TIME_LIMIT
- For both LOITER_TIME and LOITER_TO_ALT in fixed-wing flight, unify logic:
--> reach position --> start loitering --> reach altitude --> start timer (if applicable)
--> reach exit heading (if applicable) --> declare mission item reached
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-29 19:36:59 +01:00
Silvan Fuhrer
5c9fac58c8
Mission: do not autocontinue if in multicopter mode and next wp has a hold time
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-29 19:36:59 +01:00
Silvan Fuhrer
f3adf6d67f
mission_block: rename altitude_amsl to mission_item_altitude_amsl to make clear it's a setpoint
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-29 19:36:59 +01:00
Silvan Fuhrer
017567792b
Navigator: for loiter position acceptance, use L1 distance and loiter radius
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-29 19:36:59 +01:00
Silvan Fuhrer
acbada73dd
RTL: VTOL: do the land delay loitering (RTL_LAND_DELAY) in fixed-wing flight
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-29 15:46:33 +03:00
Daniel Agar
d1dfa26903
consume all available queued vehicle_commands
2021-01-26 12:00:18 -05:00
Julian Kent
fc6b61dad1
Try 'min' for units
2021-01-18 16:26:53 +01:00
Julian Kent
d99d52960e
Fix default _rtl_xxx values
2021-01-18 16:26:53 +01:00
Julian Kent
5a9fe312b5
Fix test failure on rebase: set lpos valid
2021-01-18 16:26:53 +01:00
Julian Kent
af8d178ae5
Fix spurious RTL triggers
...
Two sources:
1. global to local conversion was sometimes giving issues, so do everything in global
2. on startup the RTL didn't check if the home position was valid before processing it
2021-01-18 16:26:53 +01:00
Julian Kent
b5f0a7ea03
Fix RangeRTL test
2021-01-18 16:26:53 +01:00
Julian Kent
5500a84b6a
Add timestamp to RTL message
2021-01-18 16:26:53 +01:00
Julian Kent
67082ccb2b
Test the vehicle type parameter usage
2021-01-18 16:26:53 +01:00
Julian Kent
100c64c790
Test the navigator side, and fix another trig edge case
2021-01-18 16:26:53 +01:00
Julian Kent
a736ba2435
Minor tweak in wind handling
2021-01-18 16:26:53 +01:00
Julian Kent
e847ef1a4d
Add trig tests for wind calculations, and fix bugs / edge cases
2021-01-18 16:26:53 +01:00
Julian Kent
7482413005
Add Range-based RTL
2021-01-18 16:26:53 +01:00
Silvan Fuhrer
195a900ecf
change default of RTL_LAND_DELAY to 0
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-17 12:05:30 +01:00
Julian Kent
be0f5a7fe4
Fix implicit float->double conversions in tests
2021-01-13 10:26:10 +01:00
Julian Kent
2d6758a39d
Cleanup of dataman mocks and check interval definition
2021-01-13 10:26:10 +01:00
Julian Kent
a97a4d8bb8
Fix enum and param update
2021-01-13 10:26:10 +01:00
Julian Kent
c745c8bb45
Small navigator refactor/cleanup
2021-01-13 10:26:10 +01:00
Julian Kent
04d859e36e
Fix test failure from parameter autosave starting WQ
2021-01-13 10:26:10 +01:00
RomanBapst
f97dcde4e2
GeofenceBreachAvoidanceTest: added tests for max dist to home
...
Signed-off-by: Julian Kent <julian@auterion.com >
2021-01-13 10:26:10 +01:00
RomanBapst
3fa15cec91
GeofenceBreachAvoidance: improve behavior when using max dist to home option
...
- ensure that the vehicle is loitering with sufficient clearance to the boundary
Signed-off-by: Julian Kent <julian@auterion.com >
2021-01-13 10:26:10 +01:00
RomanBapst
0ac597fba8
Use new GeofenceBreachAvoidance from Navigator
...
Signed-off-by: Julian Kent <julian@auterion.com >
2021-01-13 10:26:10 +01:00
RomanBapst
e536868104
Add GeofenceBreachAvoidance class
...
Signed-off-by: Julian Kent <julian@auterion.com >
2021-01-13 10:26:10 +01:00
Daniel Agar
967d35a6b6
rate limit most parameter_update subscriptions
...
- parameter updates can be quite expensive because they trigger nearly all modules to reload all of their parameters immediately
- limit modules from updating faster than once per second
2021-01-10 21:09:15 -05:00
Matthias Grob
2fc212e064
geofence_params: clarify EKF vs baro altitude source
2021-01-10 18:40:58 +01:00
Hamish Willee
d5c8d0a233
GF_ALTMODE: Update in line with Lorenz feedback
2021-01-10 18:40:58 +01:00
Hamish Willee
d43444fce7
geofence: GF_ALTMODE clarification
2021-01-10 18:40:58 +01:00
Silvan Fuhrer
92634e7549
RTL: during climb, set NAV_CMD_WAYPOINT for RW modes, NAV_CMD_LOITER_TO_ALT for FW
...
Do not use LOITER_TO_ALT for rotary wing mode as it would then always climb to
at least MIS_LTRMIN_ALT, even if current clib altitude is below
(e.g. RTL immediately after take off)
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-04 11:58:16 +01:00
Silvan Fuhrer
55a1d090a1
RTL: use NAV_CMD_LOITER_TO_ALT for Climb state
...
Signed-off-by: Silvan Fuhrer <silvan@auterion.com >
2021-01-04 11:58:16 +01:00
RomanBapst
68f27ba7b7
navigator: deactivate line following after backt-ransition and before landing
...
- especially when there are strong winds it's better to just go straight
to the landing point instead of trying to follow the planned path
Signed-off-by: RomanBapst <bapstroman@gmail.com >
2021-01-04 11:58:16 +01:00
RomanBapst
b63f756745
navigator: don't execute land pattern if vtol in rotary wing mode
...
- if vtol and in rotary wing mode then don't execute the mission landing
because it's designed to be flow as a fixed wing
- if vtol and in rotary wing mode and mission land is available then fly directly
to landing point and don't go home!
Signed-off-by: RomanBapst <bapstroman@gmail.com >
2021-01-04 11:58:16 +01:00
RomanBapst
6c3f413379
mission: reset work_item_type during mission inactivation
...
- this fixes a race condition which happens when an RTL is triggered
during the final approach of a mission landing. In that case the mission inactive
method is never called.
Signed-off-by: RomanBapst <bapstroman@gmail.com >
2021-01-04 11:58:16 +01:00
RomanBapst
b63f202b3c
various fixed for bugs encountered during testing
...
Signed-off-by: RomanBapst <bapstroman@gmail.com >
2021-01-04 11:58:16 +01:00
RomanBapst
cfb3cdc82f
rtl: use math namespace
...
Signed-off-by: RomanBapst <bapstroman@gmail.com >
2021-01-04 11:58:16 +01:00
RomanBapst
94d3ab28ee
rtl: fixed computation of return altitude when mission landing is available
...
Signed-off-by: RomanBapst <bapstroman@gmail.com >
2021-01-04 11:58:16 +01:00