|
Formula Student Autonomous Systems
The code for the main driverless system
|
Motion model that predicts the pose of the robot given the velocities with a constant acceleration and turnrate model. More...
#include <constant_acceleration_turnrate_model.hpp>


Public Member Functions | |
| Eigen::Vector3d | get_pose_difference (const Eigen::Vector3d &previous_pose, const Eigen::VectorXd &motion_data, const double delta_t) override |
| Gives the increments to the pose instead of the next pose. | |
| Eigen::Matrix3d | get_jacobian_pose (const Eigen::Vector3d &previous_pose, const Eigen::VectorXd &motion_data, const double delta_t) override |
| Get the Jacobian matrix of the motion model in relation to the pose (state) | |
| Eigen::MatrixXd | get_jacobian_motion_data (const Eigen::Vector3d &previous_pose, const Eigen::VectorXd &motion_data, const double delta_t) override |
| Get the Jacobian matrix of the motion model in relation to motion data (commands) | |
Public Member Functions inherited from V2PMotionModel | |
| virtual | ~V2PMotionModel ()=default |
| virtual Eigen::Vector3d | get_next_pose (const Eigen::Vector3d &previous_pose, const Eigen::VectorXd &motion_data, const double delta_t) |
| Predict the pose of the robot given the motion data. | |
Motion model that predicts the pose of the robot given the velocities with a constant acceleration and turnrate model.
Definition at line 11 of file constant_acceleration_turnrate_model.hpp.
|
overridevirtual |
Get the Jacobian matrix of the motion model in relation to motion data (commands)
This is used to multiplty by the motion data noise to get the matrix to be summed to the covariance
| previous_pose | |
| motion_data | (vx, vy, omega, ax) |
| delta_t |
Implements V2PMotionModel.
Definition at line 62 of file constant_acceleration_turnrate_model.cpp.
|
overridevirtual |
Get the Jacobian matrix of the motion model in relation to the pose (state)
This is used to multiplty by the previous covariance to get the matrix, propagating the previous pose error to the current pose error (variance)
| previous_pose | |
| motion_data | (vx, vy, omega, ax) |
| delta_t |
Implements V2PMotionModel.
Definition at line 35 of file constant_acceleration_turnrate_model.cpp.
|
overridevirtual |
Gives the increments to the pose instead of the next pose.
| previous_pose | |
| motion_data | (vx, vy, omega, ax) |
| delta_t |
Implements V2PMotionModel.
Definition at line 6 of file constant_acceleration_turnrate_model.cpp.
