#include <position_velocity.h>
Public Member Functions | |
VectorXd | Configuration () const |
void | FromRos (const fastrack_msgs::State &msg) |
void | FromVector (const VectorXd &x) |
std::vector< Vector3d > | OccupiedPositions () const |
PositionVelocity & | operator*= (double s) |
PositionVelocity & | operator+= (const PositionVelocity &rhs) |
PositionVelocity & | operator-= (const PositionVelocity &rhs) |
PositionVelocity & | operator/= (double s) |
Vector3d | Position () const |
Vector3d & | Position () |
PositionVelocity () | |
PositionVelocity (double x, double y, double z, double vx, double vy, double vz) | |
PositionVelocity (const Vector3d &position, const Vector3d &velocity) | |
PositionVelocity (const fastrack_msgs::State &msg) | |
PositionVelocity (const VectorXd &x) | |
void | SetConfigurationDot (const VectorXd &configuration_dot) |
fastrack_msgs::State | ToRos () const |
VectorXd | ToVector () const |
Vector3d | Velocity () const |
Vector3d & | Velocity () |
double | Vx () const |
double & | Vx () |
double | Vy () const |
double & | Vy () |
double | Vz () const |
double & | Vz () |
double | X () const |
double & | X () |
double | Y () const |
double & | Y () |
double | Z () const |
double & | Z () |
~PositionVelocity () | |
Public Member Functions inherited from fastrack::state::State | |
void | FromRosPtr (const fastrack_msgs::State::ConstPtr &msg) |
virtual | ~State () |
Static Public Member Functions | |
static constexpr size_t | ConfigurationDimension () |
static VectorXd | GetConfigurationLower () |
static VectorXd | GetConfigurationUpper () |
static const PositionVelocity & | GetLower () |
static const PositionVelocity & | GetUpper () |
static PositionVelocity | Sample () |
static PositionVelocity | SampleCloseTo (const Vector3d &pos, double d) |
static VectorXd | SampleConfiguration () |
static void | SetBounds (const PositionVelocity &lower, const PositionVelocity &upper) |
static void | SetBounds (const std::vector< double > &lower, const std::vector< double > &upper) |
static constexpr size_t | StateDimension () |
Static Public Member Functions inherited from fastrack::state::State | |
static void | Seed (unsigned int seed) |
Private Attributes | |
Vector3d | position_ |
Vector3d | velocity_ |
Static Private Attributes | |
static PositionVelocity | lower_ |
static PositionVelocity | upper_ |
Friends | |
PositionVelocity | operator* (PositionVelocity lhs, double s) |
PositionVelocity | operator* (double s, PositionVelocity rhs) |
PositionVelocity | operator+ (PositionVelocity lhs, const PositionVelocity &rhs) |
PositionVelocity | operator- (PositionVelocity lhs, const PositionVelocity &rhs) |
PositionVelocity | operator/ (PositionVelocity lhs, double s) |
PositionVelocity | operator/ (double s, PositionVelocity rhs) |
Additional Inherited Members | |
Protected Member Functions inherited from fastrack::state::State | |
State () | |
Static Protected Attributes inherited from fastrack::state::State | |
static std::random_device | rd_ |
static std::default_random_engine | rng_ = std::default_random_engine(State::rd_()) |
Definition at line 52 of file position_velocity.h.
|
inline |
Definition at line 54 of file position_velocity.h.
|
inlineexplicit |
Definition at line 55 of file position_velocity.h.
|
explicit |
Definition at line 57 of file position_velocity.cpp.
|
explicit |
Definition at line 60 of file position_velocity.cpp.
|
explicit |
Definition at line 63 of file position_velocity.cpp.
|
explicit |
Definition at line 83 of file position_velocity.cpp.
|
inlinevirtual |
Implements fastrack::state::State.
Definition at line 73 of file position_velocity.h.
|
inlinestatic |
Definition at line 112 of file position_velocity.h.
|
virtual |
Implements fastrack::state::State.
Definition at line 244 of file position_velocity.cpp.
|
virtual |
Implements fastrack::state::State.
Definition at line 215 of file position_velocity.cpp.
|
static |
Definition at line 280 of file position_velocity.cpp.
|
static |
Definition at line 283 of file position_velocity.cpp.
|
static |
Definition at line 276 of file position_velocity.cpp.
|
static |
Definition at line 277 of file position_velocity.cpp.
|
virtual |
Implements fastrack::state::State.
Definition at line 180 of file position_velocity.cpp.
PositionVelocity & fastrack::state::PositionVelocity::operator*= | ( | double | s | ) |
Definition at line 300 of file position_velocity.cpp.
PositionVelocity & fastrack::state::PositionVelocity::operator+= | ( | const PositionVelocity & | rhs | ) |
Definition at line 288 of file position_velocity.cpp.
PositionVelocity & fastrack::state::PositionVelocity::operator-= | ( | const PositionVelocity & | rhs | ) |
Definition at line 294 of file position_velocity.cpp.
PositionVelocity & fastrack::state::PositionVelocity::operator/= | ( | double | s | ) |
Definition at line 306 of file position_velocity.cpp.
|
inlinevirtual |
Implements fastrack::state::State.
Definition at line 71 of file position_velocity.h.
|
inline |
Definition at line 90 of file position_velocity.h.
|
static |
Definition at line 136 of file position_velocity.cpp.
|
static |
Definition at line 159 of file position_velocity.cpp.
|
static |
Definition at line 116 of file position_velocity.cpp.
|
static |
Definition at line 185 of file position_velocity.cpp.
|
static |
Definition at line 193 of file position_velocity.cpp.
void fastrack::state::PositionVelocity::SetConfigurationDot | ( | const VectorXd & | configuration_dot | ) |
Definition at line 103 of file position_velocity.cpp.
|
inlinestatic |
Definition at line 111 of file position_velocity.h.
|
virtual |
Implements fastrack::state::State.
Definition at line 263 of file position_velocity.cpp.
|
virtual |
Implements fastrack::state::State.
Definition at line 230 of file position_velocity.cpp.
|
inline |
Definition at line 72 of file position_velocity.h.
|
inline |
Definition at line 91 of file position_velocity.h.
|
inline |
Definition at line 67 of file position_velocity.h.
|
inline |
Definition at line 86 of file position_velocity.h.
|
inline |
Definition at line 68 of file position_velocity.h.
|
inline |
Definition at line 87 of file position_velocity.h.
|
inline |
Definition at line 69 of file position_velocity.h.
|
inline |
Definition at line 88 of file position_velocity.h.
|
inlinevirtual |
Implements fastrack::state::State.
Definition at line 64 of file position_velocity.h.
|
inline |
Definition at line 83 of file position_velocity.h.
|
inlinevirtual |
Implements fastrack::state::State.
Definition at line 65 of file position_velocity.h.
|
inline |
Definition at line 84 of file position_velocity.h.
|
inlinevirtual |
Implements fastrack::state::State.
Definition at line 66 of file position_velocity.h.
|
inline |
Definition at line 85 of file position_velocity.h.
|
friend |
Definition at line 323 of file position_velocity.cpp.
|
friend |
Definition at line 328 of file position_velocity.cpp.
|
friend |
Definition at line 313 of file position_velocity.cpp.
|
friend |
Definition at line 318 of file position_velocity.cpp.
|
friend |
Definition at line 333 of file position_velocity.cpp.
|
friend |
Definition at line 338 of file position_velocity.cpp.
|
staticprivate |
Definition at line 155 of file position_velocity.h.
|
private |
Definition at line 151 of file position_velocity.h.
|
staticprivate |
Definition at line 156 of file position_velocity.h.
|
private |
Definition at line 152 of file position_velocity.h.