fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-11-01 00:51:35 +08:00
Code Issues Packages Projects Releases Wiki Activity

dataman: extend for double storage geofence and safe points

Browse Source
This commit is contained in:
Konrad
2024-01-30 11:25:37 -05:00
committed by Daniel Agar
parent dfa56d474a
commit 50f1abaef1
8 changed files with 79 additions and 60 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/dataman/dataman.h
+21 -3
View File
@@ -44,8 +44,12 @@
/** Types of items that the data manager can store */
typedef enum {
DM_KEY_SAFE_POINTS = 0, ///< Safe points coordinates, safe point 0 is home point
DM_KEY_FENCE_POINTS, ///< Fence vertex coordinates
DM_KEY_SAFE_POINTS_0 = 0, ///< Safe points storage 0
DM_KEY_SAFE_POINTS_1, ///< Safe points storage 1 (alternate between 0 and 1)
DM_KEY_SAFE_POINTS_STATE, ///< Persistent safe point state
DM_KEY_FENCE_POINTS_0, ///< Fence vertex storage 0
DM_KEY_FENCE_POINTS_1, ///< Fence vertex storage 1 (alternate between 0 and 1)
DM_KEY_FENCE_POINTS_STATE, ///< Persistent fence vertex state
DM_KEY_WAYPOINTS_OFFBOARD_0, ///< Mission way point coordinates sent over mavlink
DM_KEY_WAYPOINTS_OFFBOARD_1, ///< (alternate between 0 and 1)
DM_KEY_MISSION_STATE, ///< Persistent mission state
@@ -66,7 +70,9 @@ typedef enum {
#if defined(MEMORY_CONSTRAINED_SYSTEM)
enum {
DM_KEY_SAFE_POINTS_MAX = 8,
DM_KEY_SAFE_POINTS_STATE_MAX = 1,
DM_KEY_FENCE_POINTS_MAX = 16,
DM_KEY_FENCE_POINTS_STATE_MAX = 1,
DM_KEY_WAYPOINTS_OFFBOARD_0_MAX = NUM_MISSIONS_SUPPORTED,
DM_KEY_WAYPOINTS_OFFBOARD_1_MAX = NUM_MISSIONS_SUPPORTED,
DM_KEY_MISSION_STATE_MAX = 1,
@@ -75,7 +81,9 @@ enum {
#else
enum {
DM_KEY_SAFE_POINTS_MAX = 32,
DM_KEY_SAFE_POINTS_STATE_MAX = 1,
DM_KEY_FENCE_POINTS_MAX = 64,
DM_KEY_FENCE_POINTS_STATE_MAX = 1,
DM_KEY_WAYPOINTS_OFFBOARD_0_MAX = NUM_MISSIONS_SUPPORTED,
DM_KEY_WAYPOINTS_OFFBOARD_1_MAX = NUM_MISSIONS_SUPPORTED,
DM_KEY_MISSION_STATE_MAX = 1,
@@ -86,7 +94,11 @@ enum {
/* table of maximum number of instances for each item type */
static const unsigned g_per_item_max_index[DM_KEY_NUM_KEYS] = {
DM_KEY_SAFE_POINTS_MAX,
DM_KEY_SAFE_POINTS_MAX,
DM_KEY_SAFE_POINTS_STATE_MAX,
DM_KEY_FENCE_POINTS_MAX,
DM_KEY_FENCE_POINTS_MAX,
DM_KEY_FENCE_POINTS_STATE_MAX,
DM_KEY_WAYPOINTS_OFFBOARD_0_MAX,
DM_KEY_WAYPOINTS_OFFBOARD_1_MAX,
DM_KEY_MISSION_STATE_MAX,
@@ -98,7 +110,9 @@ struct dataman_compat_s {
};
constexpr uint32_t MISSION_SAFE_POINT_SIZE = sizeof(struct mission_item_s);
constexpr uint32_t MISSION_SAFE_POINT_STATE_SIZE = sizeof(struct mission_stats_entry_s);
constexpr uint32_t MISSION_FENCE_POINT_SIZE = sizeof(struct mission_fence_point_s);
constexpr uint32_t MISSION_FENCE_POINT_STATE_SIZE = sizeof(struct mission_stats_entry_s);
constexpr uint32_t MISSION_ITEM_SIZE = sizeof(struct mission_item_s);
constexpr uint32_t MISSION_SIZE = sizeof(struct mission_s);
constexpr uint32_t DATAMAN_COMPAT_SIZE = sizeof(struct dataman_compat_s);
@@ -106,7 +120,11 @@ constexpr uint32_t DATAMAN_COMPAT_SIZE = sizeof(struct dataman_compat_s);
/** The table of the size of each item type */
static constexpr size_t g_per_item_size[DM_KEY_NUM_KEYS] = {
MISSION_SAFE_POINT_SIZE,
MISSION_SAFE_POINT_SIZE,
MISSION_SAFE_POINT_STATE_SIZE,
MISSION_FENCE_POINT_SIZE,
MISSION_FENCE_POINT_SIZE,
MISSION_FENCE_POINT_STATE_SIZE,
MISSION_ITEM_SIZE,
MISSION_ITEM_SIZE,
MISSION_SIZE,
@@ -114,7 +132,7 @@ static constexpr size_t g_per_item_size[DM_KEY_NUM_KEYS] = {
};
/* increment this define whenever a binary incompatible change is performed */
#define DM_COMPAT_VERSION 4ULL
#define DM_COMPAT_VERSION 5ULL
#define DM_COMPAT_KEY ((DM_COMPAT_VERSION << 32) + (sizeof(struct mission_item_s) << 24) + \
(sizeof(struct mission_s) << 16) + (sizeof(struct mission_stats_entry_s) << 12) + \