|
LRAUV
revA
|
Contains the Lane Behavior/Command. More...
#include <Lane.h>


Public Member Functions | |
| Lane (const Str &prefix, const Module *module) | |
| virtual | ~Lane () |
| void | readSettings () |
| Read settings. More... | |
| void | initialize (void) |
| Initialize function. More... | |
| bool | isSatisfied () |
| Returns true when vehicle has "arrived" within the angle of the waypoint. More... | |
| bool | runIfUnsatisfied () |
| runs only if unsatisfied More... | |
| void | run () |
| The actual "payload" of the component. More... | |
| void | uninitialize (void) |
| Uninit function. More... | |
Public Member Functions inherited from Behavior | |
| virtual | ~Behavior () |
| bool | executeIfUnsatisfied () |
| Combined run and test with metrics generation. More... | |
| virtual void | preempted () |
| virtual bool | isRunnable () |
| virtual bool | isSatisfiable () |
| virtual bool | isCommand () |
| BehaviorState | getBehaviorState () const |
| void | setBehaviorState (BehaviorState behaviorState) |
| virtual bool | isCompleted (void) |
| Query if this component is completed. More... | |
| SettingReader * | findSettingReader (const Str &settingURI) |
| SettingReader * | addValueClause (const Str &uriPart, ValueClause *valueClause) |
| void | addArgWriter (const Str &uriPart, DataWriter *argWriter) |
| const Timespan & | getTimeout () |
| void | setTimeout (const Timespan &timeout) |
Public Member Functions inherited from Component | |
| virtual | ~Component () |
| Destructor cleans up readers_ and writers_. More... | |
| void | registerReader (DataReader *reader) |
| void | unregisterReader (DataReader *reader) |
| void | registerWriter (DataWriter *writer) |
| void | unregisterWriter (DataWriter *writer) |
| void | disableMetering (void) |
| FlexArray< DataReader * > & | getReaderList (void) |
| FlexArray< DataWriter * > & | getWriterList (void) |
| const Module * | getModule () |
| virtual void | configure () |
| Read (or re-read!) configuration settings. More... | |
| virtual void | execute (void) |
| bool | isActive () const |
| Indicates if the component is active. More... | |
| const CodedStr & | getName (void) const |
| Returns the name. More... | |
| const Timestamp & | getTimeOfLastRun (void) const |
| ComponentState | getState (void) |
| Return the component's current state. More... | |
| void | setState (ComponentState state) |
| RunState | getRunState (void) |
| Return the component's run state. More... | |
| bool | isUsingRunState () |
| Return true if using runState. More... | |
| void | requestData (bool requestingData) |
| Tell the component to start (or stop) sending data. More... | |
| void | requestStart () |
| Tell the component to start runnning. More... | |
| void | requestPause (const Timespan expectedPauseTime) |
| Tell the component to pause runnning. More... | |
| void | requestResume () |
| Tell the component resume from pause. More... | |
| void | requestStop () |
| Tell the component to stop runnning. More... | |
| virtual RunState | start () |
| Do what needs to be done to run Similar to initialize, in old init/run/uninit sequence. More... | |
| virtual RunState | starting () |
| Might follow a STOP...START sequence Subseqent. More... | |
| virtual RunState | runnable () |
| Should eventually follow a START request or RESETTING. More... | |
| virtual RunState | satisfied () |
| Possible return value of a Behavior. More... | |
| virtual RunState | pause () |
| Pause for a short period (indicated by pauseTime) More... | |
| virtual RunState | pausing () |
| Might follow a PAUSE request. More... | |
| virtual RunState | paused () |
| Should eventually follow a PAUSE request: should set continueTime. More... | |
| virtual RunState | resume () |
| Resume from PAUSE. More... | |
| virtual RunState | resuming () |
| Might follow a PAUSE...RESUME sequence. More... | |
| virtual RunState | resetting () |
| Might occur in case of Error. More... | |
| virtual RunState | stop () |
| Initial state – can be later followed by START. More... | |
| virtual RunState | stopping () |
| Might follow a STOP request. More... | |
| virtual RunState | stopped () |
| Should eventually follow a STOP request. More... | |
| void | setCriticalFailureReported (bool boolVal) |
| void | setRecoveringFromCritical (bool boolVal) |
| void | setFailureReported (bool boolVal) |
| bool | isFailureUninitialized () |
| void | setFailureUninitialized (bool boolVal) |
| void | setRetryTimeout (const Timespan &timeout) |
| void | setPeriod (const Timespan &period) |
| Set the period of this component... used if it is periodic. More... | |
| const Timespan & | getPeriod (void) |
| Returns the component's period (regardless of whether it is periodic) More... | |
| ComponentType | getComponentType () |
| Getter function for ComponentType. More... | |
| virtual bool | isFailed (void) const |
| virtual FailureMode::FailType | getFailureType (void) const |
| virtual bool | getCriticalFailureReported (void) const |
| virtual bool | getFailureReported (void) const |
| virtual Timespan | getRetryTimeout (void) const |
| virtual FailureMode::FailType | setFailure (FailureMode::FailType failureType) |
| virtual int | getFailCount (void) const |
| virtual bool | isFailureMissionCritical () |
| virtual int | getAllowableFailures (void) const |
| virtual void | setAllowableFailures (int fails) |
| Logger & | getLogger (void) |
| virtual int | incrementFailCount (void) |
| virtual void | resetFailCount (void) |
| virtual int | getSkippedRunsSinceFail (void) const |
| virtual int | incrementSkippedRunsSinceFail (void) |
| virtual void | logVoltage (float voltage, float averageVoltage) |
| virtual void | logCurrent (float current, float averageCurrent) |
| const Timestamp & | getWriteTimestamp (void) |
| void | setWriteTimestamp (const Timestamp &writeTimestamp) |
| BlobReader * | newBlobReader (const BlobURI &blobURI) |
| BlobReader * | newBlobReaderFromUniversal (const Str &componentName, const UniversalBlobURI &blobURI) |
| BlobWriter * | newBlobWriter (const BlobURI &blobURI, Logger::TimePrecisionType timePrecision=Logger::TIME_PRECISION_MILLIS) |
| ConfigReader * | newConfigReader (const ConfigURI &configURI) |
| DataReader * | newDataReader (const DataURI &dataURI) |
| DataReader * | newDataReaderFromUniversal (const Str &componentName, const UniversalURI &universalURI) |
| DataWriter * | newDataWriter (const DataURI &dataURI, Logger::TimePrecisionType timePrecision=Logger::TIME_PRECISION_MILLIS) |
| UniversalBlobReader * | newUniversalBlobReader (const UniversalBlobURI &universalURI) |
| UniversalBlobWriter * | newUniversalBlobWriter (const UniversalBlobURI &universalURI, const Unit &accuracyUnit=Units::NONE, const float accuracy=DataElement::NO_ACCURACY, Logger::TimePrecisionType timePrecision=Logger::TIME_PRECISION_MILLIS) |
| UniversalDataReader * | newUniversalReader (const UniversalURI &universalURI) |
| UniversalDataWriter * | newUniversalWriter (const UniversalURI &universalURI, const Unit &accuracyUnit=Units::NONE, const float accuracy=DataElement::NO_ACCURACY, Logger::TimePrecisionType timePrecision=Logger::TIME_PRECISION_MILLIS) |
Static Public Member Functions | |
| static Behavior * | CreateBehavior (const Str &prefix, const Module *module) |
| Mission Component factory interface. More... | |
Protected Member Functions | |
| void | doRun () |
| bool | calcSatisfied () |
| bool | readParams () |
Protected Member Functions inherited from Behavior | |
| Behavior (const Str &name, const Module *module, const bool runnable, const bool satisfiable) | |
| Protected constructor for abstract base class. More... | |
| Behavior (const Behavior &old) | |
| SettingReader * | newSettingReader (const Str &uriPart, const DataValue *defaultValue, bool deleteDefaultValue=true) |
| SettingReader * | newSettingReader (const SettingURI &uriPart) |
| DataWriter * | findArgWriter (const OutputURI &uriPart) |
Protected Member Functions inherited from Component | |
| virtual ConfigURI | getConfigURI (ConfigOption configOption) const |
| Should return [myNamespace]::SIMULATE_HARDWARE, or [myNamespace]::POWER, etc. More... | |
| virtual ConfigURI | getConfigURI (ConfigOption configOption, ElementURI forElement) const |
| Should return [myNamespace]::POWER_[forElement], [myNamespace]::LATENCY_[forElement], etc. More... | |
| virtual void | setDurationOfLastRun (const Timespan &span) |
| virtual void | setTimeOfRun (const Timestamp &time) |
| virtual void | setTimeOfLastRun (const Timestamp &time) |
| virtual void | setDt (const Timespan &dt) |
| virtual bool | setEnabled (bool enabled=true) |
| void | setRunState (const RunState runState) |
| const Timespan | getPauseTime () const |
| virtual void | setFailureMissionCritical (bool failureMissionCritical) |
| bool | simulateHardware () |
Protected Attributes | |
| float | bearingSetting_ |
| Desired Bearing. More... | |
| float | distanceSetting_ |
| Desired Distance. More... | |
| double | latitudeSetting_ |
| Desired (calculated) Latitude. More... | |
| double | longitudeSetting_ |
| Desired (calculated) Longitude. More... | |
| float | widthSetting_ |
| Desired width. More... | |
| float | offsetSetting_ |
| Desired offset. More... | |
| double | latitude_ |
| Current Latitude. More... | |
| double | longitude_ |
| Current Longitude. More... | |
| float | perpendicularSlope_ |
| Slope for crossing line (thru wapoint) More... | |
| bool | startOverLine_ |
| Is our starting point latitude > than the latitude of the starting longitude on the crossing line? More... | |
| bool | initialized_ |
| Indicates initialization success. More... | |
| SettingReader * | bearingSettingReader_ |
| SettingReader * | distanceSettingReader_ |
| SettingReader * | widthSettingReader_ |
| Width of the lane. More... | |
| SettingReader * | offsetSettingReader_ |
| Offset of the lane. More... | |
| UniversalDataReader * | latitudeReader_ |
| UniversalDataReader * | longitudeReader_ |
| UniversalDataReader * | headingReader_ |
| DataReader * | horizontalModeReader_ |
| DataReader * | headingCmdReader_ |
| DataReader * | bearingCmdReader_ |
| DataWriter * | horizontalModeWriter_ |
| DataWriter * | headingCmdWriter_ |
Protected Attributes inherited from Behavior | |
| bool | runnable_ |
| bool | satisfiable_ |
| BehaviorState | behaviorState_ |
| Timespan | timeout_ |
| Time before this behavior must end – defaults no timeout. More... | |
| FastMap< const Str, SettingReader * > * | settingReaderMap_ |
| FastMap< const Str, DataWriter * > * | argWriterMap_ |
Protected Attributes inherited from Component | |
| Logger | logger_ |
| Syslog::Severity | debugLevel_ |
| ComponentState | state_ |
| Keep track of whether the component has "completed" or should be run again. More... | |
| Timespan | desiredPeriod_ |
| CodedStr & | name_ |
| Store the component's name (used for logging purposes) More... | |
| Timestamp | timeOfRun_ |
| Timestamp | timeOfLastRun_ |
| Timespan | durationOfLastRun_ |
| Timespan | dt_ |
| Timespan | retryTimeout_ |
| bool | enabled_ |
| bool | failureReported_ |
| Indicates if the failure has been reported – cuts down on syslog. More... | |
| bool | criticalFailureReported_ |
| Indicates if a "Critical" failure has been reported – cuts down on syslog. More... | |
| bool | recoveringFromCritical_ |
| Indicates that a component had a previous critical failure that has been cleared temporarily awaiting final word from the component itself. More... | |
| bool | failureUninitialized_ |
| Indicates if the failure has resulted in an uninitialize call. More... | |
| int | failCount_ |
| Number of failures logged by PCaller. More... | |
| bool | failureMissionCritical_ |
| If true (default), complete failure ends mission. More... | |
| int | allowableFailures_ |
| Number of failures allowed to occur. More... | |
| int | skippedRunsSinceFail_ |
| Number of skipped runs since failureMode_ set by failCount_. More... | |
| FailureMode::FailType | failureType_ |
| Failed status. If failCount_ > 0, then this may be reset. More... | |
| Timestamp | timeOfFailure_ |
| Time of last failure. Relevant only if failed=true. More... | |
| Timestamp | writeTimestamp_ |
| Time of last write. More... | |
| FlexArray< DataReader * > | readers_ |
| FlexArray< DataWriter * > | writers_ |
| const Module * | module_ |
| Timespan | pauseTime_ |
| bool | meteringEnabled_ |
| If true, metering is enabled. More... | |
| DataWriter * | durationOfLastRunWriter_ |
| Writer for durationOfLastRun. More... | |
| DataWriter * | voltageWriter_ |
| DataWriter * | avgVoltageWriter_ |
| DataWriter * | currentWriter_ |
| DataWriter * | avgCurrentWriter_ |
| bool | persistentPause_ |
| True if data is persistent while component is paused. More... | |
Private Member Functions | |
| Lane (const Lane &old) | |
Additional Inherited Members | |
Public Types inherited from Behavior | |
| enum | BehaviorState { BEHAVIOR_INACTIVE, BEHAVIOR_CALLED, BEHAVIOR_ACTIVE, BEHAVIOR_TIMEOUT, BEHAVIOR_COMPLETED } |
Public Types inherited from Component | |
| enum | ComponentState { BLOCK_CONTINUOUS, BLOCK_PERIODIC, BLOCK_NORMAL, BLOCK_COMPLETED, BLOCK_UNKNOWN } |
| In this model, the component has basically two states: wanting to run, and completed (no longer needing to run). More... | |
| enum | ComponentType { COMPONENT_ASYNC, COMPONENT_CONFIG, COMPONENT_BEHAVIOR, COMPONENT_SYNC } |
| Components can indicate how they want to be handled by their type. More... | |
| enum | RunState { NO_RUN_STATE = 0, START, STARTING, RUNNABLE, SATISFIED, PAUSE, PAUSING, PAUSED, RESUME, RESUMING, RESETTING, STOP, STOPPING, STOPPED } |
Protected Types inherited from Component | |
| enum | ConfigOption { CONFIG_SIMULATE_HARDWARE, CONFIG_POWER, CONFIG_FREQUENCY, CONFIG_LATENCY } |
Contains the Lane Behavior/Command.
This is a very simple routine that simply points the nose of the vehicle at the indicated waypoint, until the waypoint is reached. If a angle is specified, then the waypoiny is reached when the vehicle is within the specified radius of the waypoint.
/todo implement waypoint satisfaction by "passing" waypoint
Lane.h should only be included by Lane.cpp Other classes should include LaneIF.h
References bearingCmdReader_, bearingSettingReader_, distanceSettingReader_, headingCmdReader_, headingCmdWriter_, headingReader_, horizontalModeReader_, horizontalModeWriter_, UniversalURI::LATITUDE, latitudeReader_, Component::logger_, UniversalURI::LONGITUDE, longitudeReader_, Component::newDataReader(), Component::newDataWriter(), Behavior::newSettingReader(), Component::newUniversalReader(), offsetSettingReader_, UniversalURI::PLATFORM_ORIENTATION, Logger::syslog(), and widthSettingReader_.
Referenced by CreateBehavior().
|
virtual |
|
private |
|
protected |
References latitude_, latitudeSetting_, longitude_, longitudeSetting_, perpendicularSlope_, and startOverLine_.
Referenced by isSatisfied().
Mission Component factory interface.
References Lane().
Referenced by GuidanceModule::loadComponents().
|
protected |
References bearingCmdReader_, bearingSetting_, Location::EARTH_RADIUS, Units::ENUM, HorizontalControlIF::HEADING, headingCmdReader_, headingCmdWriter_, headingReader_, horizontalModeReader_, horizontalModeWriter_, DataReader::isActive(), latitude_, latitudeSetting_, longitude_, longitudeSetting_, AuvMath::ModPi(), offsetSetting_, Units::RADIAN, DataReader::read(), DataReader::wasTouchedSinceLastRun(), HorizontalControlIF::WAYPOINT, widthSetting_, and DataWriter::write().
Referenced by run(), and runIfUnsatisfied().
|
virtual |
Initialize function.
Reimplemented from Component.
References Location::AtBearing(), bearingSetting_, bearingSettingReader_, distanceSetting_, distanceSettingReader_, Syslog::ERROR, headingReader_, initialized_, SettingReader::isActive(), DataReader::isActive(), latitudeReader_, latitudeSetting_, Component::logger_, longitudeReader_, longitudeSetting_, offsetSetting_, perpendicularSlope_, Units::RADIAN, DataReader::read(), readSettings(), UniversalDataReader::requestData(), startOverLine_, Logger::syslog(), widthSetting_, and widthSettingReader_.
Referenced by readParams().
|
virtual |
Returns true when vehicle has "arrived" within the angle of the waypoint.
Reimplemented from Behavior.
References calcSatisfied(), and readParams().
Referenced by runIfUnsatisfied().
|
protected |
References Syslog::ERROR, initialize(), initialized_, DataReader::isActive(), latitude_, latitudeReader_, Component::logger_, longitude_, longitudeReader_, Units::RADIAN, DataReader::read(), readSettings(), UniversalDataReader::requestData(), and Logger::syslog().
Referenced by isSatisfied(), run(), and runIfUnsatisfied().
| void Lane::readSettings | ( | void | ) |
Read settings.
References bearingSetting_, bearingSettingReader_, distanceSetting_, distanceSettingReader_, Units::METER, offsetSetting_, offsetSettingReader_, Units::RADIAN, SettingReader::read(), widthSetting_, and widthSettingReader_.
Referenced by initialize(), and readParams().
|
virtual |
The actual "payload" of the component.
Reimplemented from Component.
References doRun(), and readParams().
|
virtual |
runs only if unsatisfied
Reimplemented from Behavior.
References doRun(), Syslog::INFO, isSatisfied(), latitudeSetting_, Component::logger_, longitudeSetting_, R2D, readParams(), Component::satisfied(), and Logger::syslog().
|
virtual |
Uninit function.
Reimplemented from Component.
References headingReader_, initialized_, Component::logger_, UniversalDataReader::requestData(), and Logger::syslog().
|
protected |
|
protected |
Desired Bearing.
Referenced by doRun(), initialize(), and readSettings().
|
protected |
Referenced by initialize(), Lane(), and readSettings().
|
protected |
Desired Distance.
Referenced by initialize(), and readSettings().
|
protected |
Referenced by initialize(), Lane(), and readSettings().
|
protected |
|
protected |
|
protected |
Referenced by doRun(), initialize(), Lane(), and uninitialize().
|
protected |
|
protected |
|
protected |
Indicates initialization success.
Referenced by initialize(), readParams(), and uninitialize().
|
protected |
Current Latitude.
Referenced by calcSatisfied(), doRun(), and readParams().
|
protected |
Referenced by initialize(), Lane(), and readParams().
|
protected |
Desired (calculated) Latitude.
Referenced by calcSatisfied(), doRun(), initialize(), and runIfUnsatisfied().
|
protected |
Current Longitude.
Referenced by calcSatisfied(), doRun(), and readParams().
|
protected |
Referenced by initialize(), Lane(), and readParams().
|
protected |
Desired (calculated) Longitude.
Referenced by calcSatisfied(), doRun(), initialize(), and runIfUnsatisfied().
|
protected |
Desired offset.
Referenced by doRun(), initialize(), and readSettings().
|
protected |
Offset of the lane.
Referenced by Lane(), and readSettings().
|
protected |
Slope for crossing line (thru wapoint)
Referenced by calcSatisfied(), and initialize().
|
protected |
Is our starting point latitude > than the latitude of the starting longitude on the crossing line?
Referenced by calcSatisfied(), and initialize().
|
protected |
Desired width.
Referenced by doRun(), initialize(), and readSettings().
|
protected |
Width of the lane.
Referenced by initialize(), Lane(), and readSettings().