DUNE: Uniform Navigational Environment
2.6.0-rc4
|
Public Member Functions | |
Task (const std::string &name, Tasks::Context &ctx) | |
void | onResourceAcquisition (void) |
void | onResourceRelease (void) |
void | onResourceInitialization (void) |
void | consume (const IMC::VehicleState *msg) |
void | consume (const IMC::VehicleMedium *msg) |
void | consume (const IMC::EstimatedState *msg) |
void | consume (const IMC::PlanGeneration *msg) |
void | consume (const IMC::PlanControl *msg) |
void | checkDislodgeResult (const IMC::PlanControl *msg) |
void | getFinishDepth (const IMC::PlanControl *msg) |
void | failedStartPlan (void) |
void | dispatchDislodge (void) |
bool | mainConditions (void) |
bool | ascentCondition (void) |
void | setState (AssistState state) |
void | onIdle (void) |
void | onCheckStuck (void) |
void | onStartDislodge (void) |
void | onWaitDislodge (void) |
void | task (void) |
Public Member Functions inherited from DUNE::Tasks::Periodic | |
Periodic (const std::string &name, Context &ctx) | |
virtual | ~Periodic (void) |
void | setFrequency (double freq) |
double | getFrequency (void) const |
double | getRunTime (void) const |
unsigned | getRunCount (void) const |
Public Member Functions inherited from DUNE::Tasks::Task | |
Task (const std::string &name, Context &context) | |
virtual | ~Task (void) |
const char * | getName (void) const |
const char * | getSystemName (void) const |
unsigned int | getSystemId (void) const |
unsigned int | getEntityId (void) const |
unsigned int | resolveEntity (const std::string &label) const |
std::string | resolveEntity (unsigned int id) const |
uint16_t | getActivationTime (void) const |
uint16_t | getDeactivationTime (void) const |
unsigned int | resolveSystemName (const std::string &name) const |
const char * | resolveSystemId (unsigned int id) const |
void | loadConfig (void) |
void | setPriority (unsigned int value) |
unsigned int | getPriority (void) const |
void | inf (const char *format,...) DUNE_PRINTF_FORMAT(2 |
void void | war (const char *format,...) DUNE_PRINTF_FORMAT(2 |
void void void | err (const char *format,...) DUNE_PRINTF_FORMAT(2 |
void void void void | cri (const char *format,...) DUNE_PRINTF_FORMAT(2 |
void void void void void | debug (const char *format,...) DUNE_PRINTF_FORMAT(2 |
void void void void void void | trace (const char *format,...) DUNE_PRINTF_FORMAT(2 |
void void void void void void void | spew (const char *format,...) DUNE_PRINTF_FORMAT(2 |
void void void void void void void void | dispatch (IMC::Message *msg, unsigned int flags=0) |
void | dispatch (IMC::Message &msg, unsigned int flags=0) |
void | dispatchReply (const IMC::Message &original, IMC::Message &msg, unsigned int flags=0) |
void | receive (const IMC::Message *msg) |
void | reserveEntities (void) |
void | resolveEntities (void) |
void | acquireResources (void) |
void | releaseResources (void) |
void | initializeResources (void) |
void | updateParameters (bool act_deact=true) |
void | writeParamsXML (std::ostream &os) const |
Public Member Functions inherited from DUNE::Tasks::AbstractTask | |
AbstractTask (void) | |
virtual | ~AbstractTask (void) |
Public Member Functions inherited from DUNE::Concurrency::Thread | |
Thread (void) | |
virtual | ~Thread (void) |
int | getProcessorUsage (void) |
Public Member Functions inherited from DUNE::Concurrency::Runnable | |
Runnable (void) | |
virtual | ~Runnable (void) |
void | start (void) |
void | stop (void) |
void | join (void) |
void | stopAndJoin (void) |
void | setPriority (Scheduler::Policy policy, unsigned priority) |
State | getState (void) |
bool | isCreated (void) |
bool | isStopping (void) |
bool | isRunning (void) |
bool | isStarting (void) |
bool | isDead (void) |
Public Attributes | |
float | m_depth |
uint8_t | m_medium |
uint8_t | m_vstate |
AscentRate * | m_ar |
AssistState | m_astate |
Time::Counter< float > | m_dtimer |
float | m_finish_depth |
Arguments | m_args |
Additional Inherited Members | |
Public Types inherited from DUNE::Concurrency::Runnable | |
enum | State { StateStarting, StateRunning, StateStopping, StateDead, StateUnknown } |
Protected Member Functions inherited from DUNE::Tasks::Task | |
const char * | getEntityLabel (void) const |
void | setEntityLabel (const std::string &label) |
void | setEntityState (IMC::EntityState::StateEnum state, Status::Code code) |
void | setEntityState (IMC::EntityState::StateEnum state, const std::string &description) |
IMC::EntityState::StateEnum | getEntityState (void) const |
unsigned int | reserveEntity (const std::string &label) |
bool | stopping (void) |
bool | isActive (void) const |
bool | isActivating (void) const |
bool | isDeactivating (void) const |
void | waitForMessages (double timeout) |
void | consumeMessages (void) |
template<typename T > | |
Parameter & | param (const std::string &name, T &var) |
template<typename Y , typename T > | |
Parameter & | param (const std::string &name, T &var) |
template<typename T > | |
bool | paramChanged (T &var) |
void | paramActive (Parameter::Scope def_scope, Parameter::Visibility def_visibility, bool def_value=false) |
void | setParamSectionEditor (const std::string &name) |
template<typename M , typename T > | |
void | bind (T *task_obj, void(T::*consumer)(const M *)=&T::consume) |
template<typename T > | |
void | bind (T *task_obj, const std::vector< uint32_t > &list) |
template<typename T , typename M > | |
void | bind (T *task_obj, const std::vector< uint32_t > &list, void(T::*consumer)(const M *)=&T::consume) |
template<typename T > | |
void | bind (T *task_obj, const std::vector< std::string > &list) |
void | requestActivation (void) |
void | requestDeactivation (void) |
void | activate (void) |
void | activationFailed (const std::string &reason) |
void | deactivate (void) |
void | deactivationFailed (const std::string &reason) |
virtual void | onEntityReservation (void) |
virtual void | onEntityResolution (void) |
virtual void | onReportEntityState (void) |
virtual void | onUpdateParameters (void) |
virtual void | onRequestActivation (void) |
virtual void | onRequestDeactivation (void) |
virtual void | onActivation (void) |
virtual void | onDeactivation (void) |
Protected Member Functions inherited from DUNE::Concurrency::Thread | |
void | startImpl (void) |
void | stopImpl (void) |
void | joinImpl (void) |
void | setPriorityImpl (Scheduler::Policy policy, unsigned priority) |
Protected Attributes inherited from DUNE::Tasks::Task | |
Context & | m_ctx |
|
inline |
References Supervisors::AUV::Assist::Arguments::ascent_wsize, DUNE::Tasks::Context::config, DUNE::Tasks::Parameter::defaultValue(), Supervisors::AUV::Assist::Arguments::depth_threshold, Supervisors::AUV::Assist::Arguments::dislodge_rpm, DUNE::Parsers::Config::get(), m_args, DUNE::Tasks::Task::m_ctx, Supervisors::AUV::Assist::Arguments::min_ascent_rate, DUNE::Tasks::Task::param(), Supervisors::AUV::Assist::Arguments::plan_id, and Supervisors::AUV::Assist::Arguments::trigger_time.
|
inline |
Test if the ascent rate condition hold.
References m_ar, m_args, Supervisors::AUV::Assist::AscentRate::mean(), and Supervisors::AUV::Assist::Arguments::min_ascent_rate.
Referenced by onCheckStuck().
|
inline |
Check if the received PlanControl message reports to a successful Dislodge plan request.
[in] | msg | pointer to PlanControl message |
References m_args, Supervisors::AUV::Assist::Arguments::plan_id, setState(), Supervisors::AUV::Assist::ST_CHECK_STUCK, and Supervisors::AUV::Assist::ST_IDLE.
Referenced by consume().
|
inline |
References m_vstate.
|
inline |
References m_medium.
|
inline |
|
inline |
|
inline |
|
inline |
Dispatch the dislodge plan.
References Supervisors::AUV::Assist::Arguments::dislodge_rpm, DUNE::Tasks::Task::dispatch(), m_args, and Supervisors::AUV::Assist::Arguments::plan_id.
Referenced by setState().
|
inline |
Signal that the start of the dislodge plan has failed.
References DUNE::Tasks::Task::err(), m_args, and Supervisors::AUV::Assist::Arguments::plan_id.
Referenced by consume(), and onStartDislodge().
|
inline |
Check if the received PlanControl message reports to a plan that has just finished.
If so, save the depth at which the plan ended
[in] | msg | pointer to PlanControl message |
References m_depth, and m_finish_depth.
Referenced by consume().
|
inline |
Test the main conditions to consider throwing a dislodge plan.
References Supervisors::AUV::Assist::Arguments::depth_threshold, m_args, m_depth, m_finish_depth, m_medium, and m_vstate.
Referenced by onCheckStuck(), and onIdle().
|
inline |
Routine to run when on checkstuck state.
References ascentCondition(), m_dtimer, mainConditions(), setState(), Supervisors::AUV::Assist::ST_IDLE, and Supervisors::AUV::Assist::ST_START_DISLODGE.
Referenced by task().
|
inline |
Routine to run when on idle state.
References m_dtimer, mainConditions(), setState(), and Supervisors::AUV::Assist::ST_CHECK_STUCK.
Referenced by task().
|
inlinevirtual |
Called when the task is instructed to acquire resources whose configuration is defined by run-time parameters.
Reimplemented from DUNE::Tasks::Task.
References Supervisors::AUV::Assist::Arguments::ascent_wsize, m_ar, and m_args.
|
inlinevirtual |
Called when the task is instructed to initialize resources acquired previously or whose initialization depends on run-time parameters.
Reimplemented from DUNE::Tasks::Task.
References DUNE::Tasks::Task::setEntityState().
|
inlinevirtual |
Called when the task is instructed to release resources.
Derived classes that override this function must not assume that any resource was previously acquired. This function must be implemented in such a way that it can be called at any time.
Reimplemented from DUNE::Tasks::Task.
References m_ar.
|
inline |
Routine to run when on startdislodge state.
References failedStartPlan(), m_dtimer, setState(), and Supervisors::AUV::Assist::ST_CHECK_STUCK.
Referenced by task().
|
inline |
Routine to run when waiting for dislodge to end.
Referenced by task().
|
inline |
Set the state machine's current state.
[in] | state | target state to which the machine should transition |
References dispatchDislodge(), m_args, m_astate, m_dtimer, Supervisors::AUV::Assist::ST_CHECK_STUCK, Supervisors::AUV::Assist::ST_START_DISLODGE, and Supervisors::AUV::Assist::Arguments::trigger_time.
Referenced by checkDislodgeResult(), consume(), onCheckStuck(), onIdle(), and onStartDislodge().
|
inlinevirtual |
The task to be executed on each cycle.
Implements DUNE::Tasks::Periodic.
References m_astate, onCheckStuck(), onIdle(), onStartDislodge(), onWaitDislodge(), Supervisors::AUV::Assist::ST_CHECK_STUCK, Supervisors::AUV::Assist::ST_IDLE, Supervisors::AUV::Assist::ST_START_DISLODGE, and Supervisors::AUV::Assist::ST_WAIT_DISLODGE.
AscentRate* Supervisors::AUV::Assist::Task::m_ar |
Rate of ascent.
Referenced by ascentCondition(), consume(), onResourceAcquisition(), and onResourceRelease().
Arguments Supervisors::AUV::Assist::Task::m_args |
Task arguments.
Referenced by ascentCondition(), checkDislodgeResult(), consume(), dispatchDislodge(), failedStartPlan(), mainConditions(), onResourceAcquisition(), setState(), and Task().
AssistState Supervisors::AUV::Assist::Task::m_astate |
Task's state.
Referenced by consume(), setState(), and task().
float Supervisors::AUV::Assist::Task::m_depth |
Current depth.
Referenced by consume(), getFinishDepth(), and mainConditions().
Time::Counter<float> Supervisors::AUV::Assist::Task::m_dtimer |
Timer for triggering the dislodge.
Referenced by onCheckStuck(), onIdle(), onStartDislodge(), and setState().
float Supervisors::AUV::Assist::Task::m_finish_depth |
Finish depth of the running plan.
Referenced by consume(), getFinishDepth(), and mainConditions().
uint8_t Supervisors::AUV::Assist::Task::m_medium |
Current Medium.
Referenced by consume(), and mainConditions().
uint8_t Supervisors::AUV::Assist::Task::m_vstate |
Current vehicle state.
Referenced by consume(), and mainConditions().