constant_velocity_model.hpp

Go to the documentation of this file.

#pragma once
 
#include <Eigen/Dense>
 
#include "motion_lib/v2p_models/base_v2p_motion_model.hpp"
 
class ConstantVelocityModel : public V2PMotionModel {
public:
  Eigen::Vector3d get_pose_difference(const Eigen::Vector3d &previous_pose,
                                      const Eigen::VectorXd &motion_data,
                                      const double delta_t) override;
 
  Eigen::Matrix3d get_jacobian_pose(const Eigen::Vector3d &previous_pose,
                                    const Eigen::VectorXd &motion_data,
                                    const double delta_t) override;
 
  Eigen::MatrixXd get_jacobian_motion_data(const Eigen::Vector3d &previous_pose,
                                           [[maybe_unused]] const Eigen::VectorXd &motion_data,
                                           const double delta_t) override;
};