Class to define acceleration in cartesian space as 3D linear and angular acceleration vectors.
More...
|
const Eigen::Vector3d & | get_position () const =delete |
|
const Eigen::Quaterniond & | get_orientation () const =delete |
|
Eigen::Vector4d | get_orientation_coefficients () const =delete |
|
Eigen::Matrix< double, 7, 1 > | get_pose () const =delete |
|
Eigen::Matrix4d | get_transformation_matrix () const =delete |
|
const Eigen::Vector3d & | get_linear_velocity () const =delete |
|
const Eigen::Vector3d & | get_angular_velocity () const =delete |
|
Eigen::Matrix< double, 6, 1 > | get_twist () const =delete |
|
const Eigen::Vector3d & | get_force () const =delete |
|
const Eigen::Vector3d & | get_torque () const =delete |
|
Eigen::Matrix< double, 6, 1 > | get_wrench () const =delete |
|
void | set_position (const Eigen::Vector3d &position)=delete |
|
void | set_position (const std::vector< double > &position)=delete |
|
void | set_position (const double &x, const double &y, const double &z)=delete |
|
void | set_orientation (const Eigen::Quaterniond &orientation)=delete |
|
void | set_orientation (const Eigen::Vector4d &orientation)=delete |
|
void | set_orientation (const std::vector< double > &orientation)=delete |
|
void | set_orientation (const double &w, const double &x, const double &y, const double &z)=delete |
|
void | set_pose (const Eigen::Vector3d &position, const Eigen::Quaterniond &orientation)=delete |
|
void | set_pose (const Eigen::Matrix< double, 7, 1 > &pose)=delete |
|
void | set_pose (const std::vector< double > &pose)=delete |
|
void | set_linear_velocity (const Eigen::Vector3d &linear_velocity)=delete |
|
void | set_linear_velocity (const std::vector< double > &linear_velocity)=delete |
|
void | set_linear_velocity (const double &x, const double &y, const double &z)=delete |
|
void | set_angular_velocity (const Eigen::Vector3d &angular_velocity)=delete |
|
void | set_angular_velocity (const std::vector< double > &angular_velocity)=delete |
|
void | set_angular_velocity (const double &x, const double &y, const double &z)=delete |
|
void | set_twist (const Eigen::Matrix< double, 6, 1 > &twist)=delete |
|
void | set_twist (const std::vector< double > &twist)=delete |
|
void | set_force (const Eigen::Vector3d &force)=delete |
|
void | set_force (const std::vector< double > &force)=delete |
|
void | set_force (const double &x, const double &y, const double &z)=delete |
|
void | set_torque (const Eigen::Vector3d &torque)=delete |
|
void | set_torque (const std::vector< double > &torque)=delete |
|
void | set_torque (const double &x, const double &y, const double &z)=delete |
|
void | set_wrench (const Eigen::Matrix< double, 6, 1 > &wrench)=delete |
|
void | set_wrench (const std::vector< double > &wrench)=delete |
|
CartesianState | operator*= (const CartesianState &state)=delete |
|
CartesianState | operator* (const CartesianState &state)=delete |
|
| CartesianAcceleration () |
| Empty constructor. More...
|
|
| CartesianAcceleration (const std::string &name, const std::string &reference="world") |
| Constructor with name and reference frame provided. More...
|
|
| CartesianAcceleration (const CartesianAcceleration &acceleration) |
| Copy constructor. More...
|
|
| CartesianAcceleration (const CartesianState &state) |
| Copy constructor from a CartesianState. More...
|
|
| CartesianAcceleration (const CartesianTwist &pose) |
| Copy constructor from a CartesianTwist by considering that it is equivalent to dividing the twist by 1 second. More...
|
|
| CartesianAcceleration (const std::string &name, const Eigen::Vector3d &linear_acceleration, const std::string &reference="world") |
| Construct a CartesianAcceleration from a linear acceleration given as a vector. More...
|
|
| CartesianAcceleration (const std::string &name, const Eigen::Vector3d &linear_acceleration, const Eigen::Vector3d &angular_acceleration, const std::string &reference="world") |
| Construct a CartesianAcceleration from a linear acceleration and angular acceleration given as vectors. More...
|
|
| CartesianAcceleration (const std::string &name, const Eigen::Matrix< double, 6, 1 > &acceleration, const std::string &reference="world") |
| Construct a CartesianAcceleration from a single 6d acceleration vector. More...
|
|
CartesianAcceleration & | operator= (const CartesianAcceleration &acceleration)=default |
| Copy assignment operator that have to be defined to the custom assignment operator. More...
|
|
CartesianAcceleration & | operator+= (const CartesianAcceleration &acceleration) |
| Overload the += operator. More...
|
|
CartesianAcceleration | operator+ (const CartesianAcceleration &acceleration) const |
| Overload the + operator with an acceleration. More...
|
|
CartesianAcceleration & | operator-= (const CartesianAcceleration &acceleration) |
| Overload the -= operator. More...
|
|
CartesianAcceleration | operator- (const CartesianAcceleration &acceleration) const |
| Overload the - operator with an acceleration. More...
|
|
CartesianAcceleration & | operator*= (double lambda) |
| Overload the *= operator with a scalar. More...
|
|
CartesianAcceleration | operator* (double lambda) const |
| Overload the * operator with a scalar. More...
|
|
CartesianAcceleration & | operator/= (double lambda) |
| Overload the /= operator with a scalar. More...
|
|
CartesianAcceleration | operator/ (double lambda) const |
| Overload the / operator with a scalar. More...
|
|
CartesianAcceleration & | operator*= (const Eigen::Matrix< double, 6, 6 > &lambda) |
| Overload the *= operator with a gain matrix. More...
|
|
CartesianTwist | operator* (const std::chrono::nanoseconds &dt) const |
| Overload the * operator with a time period. More...
|
|
void | clamp (double max_linear, double max_angular, double linear_noise_ratio=0, double angular_noise_ratio=0) |
| Clamp inplace the magnitude of the acceleration to the values in argument. More...
|
|
CartesianAcceleration | clamped (double max_linear, double max_angular, double noise_ratio=0, double angular_noise_ratio=0) const |
| Return the clamped twist. More...
|
|
CartesianAcceleration | copy () const |
| Return a copy of the CartesianAcceleration. More...
|
|
Eigen::VectorXd | data () const override |
| Returns the acceleration data as an Eigen vector. More...
|
|
void | set_data (const Eigen::VectorXd &data) override |
| Set the acceleration data from an Eigen vector. More...
|
|
void | set_data (const std::vector< double > &data) override |
| Set the acceleration data from a std vector. More...
|
|
CartesianAcceleration | inverse () const |
| Compute the inverse of the current CartesianAcceleration. More...
|
|
std::vector< double > | norms (const CartesianStateVariable &state_variable_type=CartesianStateVariable::ACCELERATION) const override |
| Compute the norms of the state variable specified by the input type (default is full twist) More...
|
|
CartesianAcceleration | normalized (const CartesianStateVariable &state_variable_type=CartesianStateVariable::ACCELERATION) const |
| Compute the normalized acceleration at the state variable given in argument (default is full acceleration) More...
|
|
| CartesianState () |
| Empty constructor. More...
|
|
| CartesianState (const std::string &name, const std::string &reference="world") |
| Constructor with name and reference frame provided. More...
|
|
| CartesianState (const CartesianState &state)=default |
| Copy constructor of a CartesianState.
|
|
CartesianState & | operator= (const CartesianState &state) |
| Copy assignment operator that have to be defined to the custom assignment operator. More...
|
|
const Eigen::Vector3d & | get_position () const |
| Getter of the position attribute. More...
|
|
const Eigen::Quaterniond & | get_orientation () const |
| Getter of the orientation attribute. More...
|
|
Eigen::Vector4d | get_orientation_coefficients () const |
| Getter of the orientation attribute as Vector4d of coefficients Beware, quaternion coefficients are returned using the (w, x, y, z) convention. More...
|
|
Eigen::Matrix< double, 7, 1 > | get_pose () const |
| Getter of a pose from position and orientation attributes. More...
|
|
Eigen::Matrix4d | get_transformation_matrix () const |
| Getter of a pose from position and orientation attributes. More...
|
|
const Eigen::Vector3d & | get_linear_velocity () const |
| Getter of the linear velocity attribute. More...
|
|
const Eigen::Vector3d & | get_angular_velocity () const |
| Getter of the angular velocity attribute. More...
|
|
Eigen::Matrix< double, 6, 1 > | get_twist () const |
| Getter of the 6d twist from linear and angular velocity attributes. More...
|
|
const Eigen::Vector3d & | get_linear_acceleration () const |
| Getter of the linear acceleration attribute. More...
|
|
const Eigen::Vector3d & | get_angular_acceleration () const |
| Getter of the angular acceleration attribute. More...
|
|
Eigen::Matrix< double, 6, 1 > | get_acceleration () const |
| Getter of the 6d acceleration from linear and angular acceleration attributes. More...
|
|
const Eigen::Vector3d & | get_force () const |
| Getter of the force attribute. More...
|
|
const Eigen::Vector3d & | get_torque () const |
| Getter of the torque attribute. More...
|
|
Eigen::Matrix< double, 6, 1 > | get_wrench () const |
| Getter of the 6d wrench from force and torque attributes. More...
|
|
void | set_position (const Eigen::Vector3d &position) |
| Setter of the position. More...
|
|
void | set_position (const std::vector< double > &position) |
| Setter of the position from a std vector. More...
|
|
void | set_position (const double &x, const double &y, const double &z) |
| Setter of the position from three scalar coordinates. More...
|
|
void | set_orientation (const Eigen::Quaterniond &orientation) |
| Setter of the orientation. More...
|
|
void | set_orientation (const Eigen::Vector4d &orientation) |
| Setter of the orientation from a 4d vector. More...
|
|
void | set_orientation (const std::vector< double > &orientation) |
| Setter of the orientation from a std vector. More...
|
|
void | set_orientation (const double &w, const double &x, const double &y, const double &z) |
| Setter of the orientation from four scalar coefficients (w, x, y, z) More...
|
|
void | set_pose (const Eigen::Vector3d &position, const Eigen::Quaterniond &orientation) |
| Setter of the pose from both position and orientation. More...
|
|
void | set_pose (const Eigen::Matrix< double, 7, 1 > &pose) |
| Setter of the pose from both position and orientation as Eigen 7d vector. More...
|
|
void | set_pose (const std::vector< double > &pose) |
| Setter of the pose from both position and orientation as std vector. More...
|
|
void | set_linear_velocity (const Eigen::Vector3d &linear_velocity) |
| Setter of the linear velocity attribute. More...
|
|
void | set_linear_velocity (const std::vector< double > &linear_velocity) |
| Setter of the linear velocity from a std vector. More...
|
|
void | set_linear_velocity (const double &x, const double &y, const double &z) |
| Setter of the linear velocity from three scalar coordinates. More...
|
|
void | set_angular_velocity (const Eigen::Vector3d &angular_velocity) |
| Setter of the angular velocity attribute. More...
|
|
void | set_angular_velocity (const std::vector< double > &angular_velocity) |
| Setter of the angular velocity from a std vector. More...
|
|
void | set_angular_velocity (const double &x, const double &y, const double &z) |
| Setter of the angular velocity from three scalar coordinates. More...
|
|
void | set_twist (const Eigen::Matrix< double, 6, 1 > &twist) |
| Setter of the linear and angular velocities from a 6d twist vector. More...
|
|
void | set_twist (const std::vector< double > &twist) |
| Setter of the linear and angular velocities from a std vector. More...
|
|
void | set_linear_acceleration (const Eigen::Vector3d &linear_acceleration) |
| Setter of the linear acceleration attribute. More...
|
|
void | set_linear_acceleration (const std::vector< double > &linear_acceleration) |
| Setter of the linear acceleration from a std vector. More...
|
|
void | set_linear_acceleration (const double &x, const double &y, const double &z) |
| Setter of the linear acceleration from three scalar coordinates. More...
|
|
void | set_angular_acceleration (const Eigen::Vector3d &angular_acceleration) |
| Setter of the angular velocity attribute. More...
|
|
void | set_angular_acceleration (const std::vector< double > &angular_acceleration) |
| Setter of the angular acceleration from a std vector. More...
|
|
void | set_angular_acceleration (const double &x, const double &y, const double &z) |
| Setter of the angular acceleration from three scalar coordinates. More...
|
|
void | set_acceleration (const Eigen::Matrix< double, 6, 1 > &acceleration) |
| Setter of the linear and angular acceleration from a 6d acceleration vector. More...
|
|
void | set_acceleration (const std::vector< double > &acceleration) |
| Setter of the linear and angular acceleration from a std vector. More...
|
|
void | set_force (const Eigen::Vector3d &force) |
| Setter of the force attribute. More...
|
|
void | set_force (const std::vector< double > &force) |
| Setter of the force from a std vector. More...
|
|
void | set_force (const double &x, const double &y, const double &z) |
| Setter of the force from three scalar coordinates. More...
|
|
void | set_torque (const Eigen::Vector3d &torque) |
| Setter of the torque attribute. More...
|
|
void | set_torque (const std::vector< double > &torque) |
| Setter of the torque from a std vector. More...
|
|
void | set_torque (const double &x, const double &y, const double &z) |
| Setter of the torque from three scalar coordinates. More...
|
|
void | set_wrench (const Eigen::Matrix< double, 6, 1 > &wrench) |
| Setter of the force and torque from a 6d wrench vector. More...
|
|
void | set_wrench (const std::vector< double > &wrench) |
| Setter of the force and torque from a std vector. More...
|
|
void | initialize () override |
| Initialize the CartesianState to a zero value. More...
|
|
void | set_zero () |
| Set the State to a zero value. More...
|
|
void | clamp_state_variable (double max_norm, const CartesianStateVariable &state_variable_type, double noise_ratio=0) |
| Clamp inplace the norm of the a specific state variable. More...
|
|
CartesianState | copy () const |
| Return a copy of the CartesianState. More...
|
|
virtual Eigen::VectorXd | data () const |
| Return the data as the concatenation of all the state variables in a single vector. More...
|
|
Eigen::ArrayXd | array () const |
| Return the data vector as an Eigen Array. More...
|
|
virtual void | set_data (const Eigen::VectorXd &data) override |
| Set the data of the state from all the state variables in a single Eigen vector. More...
|
|
virtual void | set_data (const std::vector< double > &data) override |
| Set the data of the state from all the state variables in a single std vector. More...
|
|
CartesianState & | operator*= (const CartesianState &state) |
| Overload the *= operator with another state by deriving the equations of motions. More...
|
|
CartesianState | operator* (const CartesianState &state) const |
| Overload the * operator with another state by deriving the equations of motions. More...
|
|
CartesianState & | operator*= (double lambda) |
| Overload the *= operator with a scalar. More...
|
|
CartesianState | operator* (double lambda) const |
| Overload the * operator with a scalar. More...
|
|
CartesianState & | operator/= (double lambda) |
| Overload the /= operator with a scalar. More...
|
|
CartesianState | operator/ (double lambda) const |
| Overload the / operator with a scalar. More...
|
|
CartesianState & | operator+= (const CartesianState &state) |
| Overload the += operator. More...
|
|
CartesianState | operator+ (const CartesianState &state) const |
| Overload the + operator. More...
|
|
CartesianState & | operator-= (const CartesianState &state) |
| Overload the -= operator. More...
|
|
CartesianState | operator- (const CartesianState &state) const |
| Overload the - operator. More...
|
|
CartesianState | inverse () const |
| Compute the inverse of the current CartesianState. More...
|
|
double | dist (const CartesianState &state, const CartesianStateVariable &state_variable_type=CartesianStateVariable::ALL) const |
| Compute the distance to another state as the sum of distances between each features. More...
|
|
virtual std::vector< double > | norms (const CartesianStateVariable &state_variable_type=CartesianStateVariable::ALL) const |
| Compute the norms of the state variable specified by the input type (default is full state) More...
|
|
void | normalize (const CartesianStateVariable &state_variable_type=CartesianStateVariable::ALL) |
| Normalize inplace the state at the state variable given in argument (default is full state) More...
|
|
CartesianState | normalized (const CartesianStateVariable &state_variable_type=CartesianStateVariable::ALL) const |
| Compute the normalized state at the state variable given in argument (default is full state) More...
|
|
std::vector< double > | to_std_vector () const |
| Return the state as a std vector. More...
|
|
| SpatialState () |
| Empty constructor. More...
|
|
| SpatialState (const StateType &type) |
| Empty constructor with a specific state type. More...
|
|
| SpatialState (const StateType &type, const std::string &name, const std::string &reference_frame="world", const bool &empty=true) |
| Constructor with name and reference frame specification. More...
|
|
| SpatialState (const SpatialState &state)=default |
| Copy constructor from another SpatialState.
|
|
SpatialState & | operator= (const SpatialState &state) |
| Copy assignment operator that have to be defined to the custom assignment operator. More...
|
|
const std::string & | get_reference_frame () const |
| Getter of the reference frame as const reference. More...
|
|
virtual void | set_reference_frame (const std::string &reference_frame) |
| Setter of the reference frame. More...
|
|
virtual bool | is_compatible (const State &state) const override |
| Check if the state is compatible for operations with the state given as argument. More...
|
|
| State () |
| Empty constructor. More...
|
|
| State (const StateType &type) |
| Constructor only specifying the type of the state from the StateType enumeration. More...
|
|
| State (const StateType &type, const std::string &name, const bool &empty=true) |
| Constructor with name specification. More...
|
|
| State (const State &state) |
| Copy constructor from another State. More...
|
|
virtual | ~State ()=default |
| Virtual destructor.
|
|
State & | operator= (const State &state) |
| Copy assignment operator that have to be defined to the custom assignment operator. More...
|
|
const StateType & | get_type () const |
| Getter of the type attribute. More...
|
|
bool | is_empty () const |
| Getter of the empty attribute. More...
|
|
void | set_empty (bool empty=true) |
| Setter of the empty attribute. More...
|
|
void | set_filled () |
| Setter of the empty attribute to false and also reset the timestamp. More...
|
|
const std::chrono::time_point< std::chrono::steady_clock > & | get_timestamp () const |
| Getter of the timestamp attribute. More...
|
|
void | set_timestamp (const std::chrono::time_point< std::chrono::steady_clock > &timepoint) |
| Setter of the timestamp attribute. More...
|
|
void | reset_timestamp () |
| Reset the timestamp attribute to now. More...
|
|
const std::string & | get_name () const |
| Getter of the name as const reference. More...
|
|
virtual void | set_name (const std::string &name) |
| Setter of the name. More...
|
|
template<typename DurationT > |
bool | is_deprecated (const std::chrono::duration< int64_t, DurationT > &time_delay) |
| Check if the state is deprecated given a certain time delay. More...
|
|
virtual bool | is_compatible (const State &state) const |
| Check if the state is compatible for operations with the state given as argument. More...
|
|
virtual void | initialize () |
| Initialize the State to a zero value. More...
|
|
virtual void | set_data (const Eigen::VectorXd &data) |
| Set the data of the state from a single Eigen vector. More...
|
|
virtual void | set_data (const std::vector< double > &data) |
| Set the data of the state from a single std vector. More...
|
|
virtual void | set_data (const Eigen::MatrixXd &data) |
| Set the data of the state from an Eigen matrix. More...
|
|
| operator bool () const noexcept |
| Boolean operator for the truthiness of a state. More...
|
|