working version of a "quick&dirty" implementation of the fail_policy

LCAS / topological_navigation

The topological navigation framework

Apache License 2.0

31 stars 36 forks source link

Closed francescodelduchetto closed 2 years ago

francescodelduchetto commented 2 years ago

Implements the following fail policy actions:

retry_N with N the number of retries, tries again to execute the same action;
wait_S_N with S the number of seconds and N the number of waits, wait action;
replan, generates a new plan which does not pass through the same edge where the fail occurred;
fail, fails the entire plan.