navigator: unify timeout waiting for payload to execute mission item command

Used for winch, gripper, gimbal to reach the desired state before continuing the mission.
Ideally we'd have feedback from all these components and not just a feed-forward delay.
This commit is contained in:
Matthias Grob
2024-11-28 20:23:36 +01:00
parent 17c24bafbc
commit ce3fcd503f
5 changed files with 52 additions and 160 deletions
+9 -15
View File
@@ -132,17 +132,6 @@ PARAM_DEFINE_FLOAT(MIS_YAW_TMT, -1.0f);
*/
PARAM_DEFINE_FLOAT(MIS_YAW_ERR, 12.0f);
/**
* Timeout for a successful payload deployment acknowledgement
*
* @unit s
* @min 0
* @decimal 1
* @increment 1
* @group Mission
*/
PARAM_DEFINE_FLOAT(MIS_PD_TO, 5.0f);
/**
* Landing abort min altitude
*
@@ -157,14 +146,19 @@ PARAM_DEFINE_FLOAT(MIS_PD_TO, 5.0f);
PARAM_DEFINE_INT32(MIS_LND_ABRT_ALT, 30);
/**
* Time in seconds allowed for the gimbal to reach its commanded attitude before the mission resumes.
* Timeout to allow the payload to execute the mission command
*
* Time allocated for a gimbal command to execute within a mission before resuming.
* This ensures the gimbal has reached the commanded orientation before beginning to take pictures.
* Ensure:
* gripper: NAV_CMD_DO_GRIPPER
* has released before continuing mission.
* winch: CMD_DO_WINCH
* has delivered before continuing mission.
* gimbal: CMD_DO_GIMBAL_MANAGER_PITCHYAW
* has reached the commanded orientation before beginning to take pictures.
*
* @unit s
* @min 0
* @decimal 1
* @group Mission
*/
PARAM_DEFINE_FLOAT(MIS_GIM_WAIT_T, 0.0f);
PARAM_DEFINE_FLOAT(MIS_COMMAND_TOUT, 0.f);