Unicycle model. More...

#include <unicycle_robot.h>

Inheritance diagram for mpc_local_planner::UnicycleModel:

[legend]

Public Member Functions
void	dynamics (const Eigen::Ref< const StateVector > &x, const Eigen::Ref< const ControlVector > &u, Eigen::Ref< StateVector > f) const override

int	getInputDimension () const override

SystemDynamicsInterface::Ptr	getInstance () const override

bool	getTwistFromControl (const Eigen::Ref< const Eigen::VectorXd > &u, geometry_msgs::Twist &twist) const override
	Convert control vector to twist message. More...

	UnicycleModel ()=default
	Default constructor. More...

Public Member Functions inherited from mpc_local_planner::BaseRobotSE2
	BaseRobotSE2 ()=default
	Default constructor. More...

void	getPoseSE2FromState (const Eigen::Ref< const Eigen::VectorXd > &x, double &pos_x, double &pos_y, double &theta) const override
	Convert state vector to pose (x,y,theta) More...

void	getPositionFromState (const Eigen::Ref< const Eigen::VectorXd > &x, double &pos_x, double &pos_y) const override
	Convert state vector to position (x,y) More...

int	getStateDimension () const override

void	getSteadyStateFromPoseSE2 (double pos_x, double pos_y, double theta, Eigen::Ref< Eigen::VectorXd > x) const override
	Convert pose (x,y,theta) to steady state. More...

bool	isContinuousTime () const override

bool	isLinear () const override

virtual bool	mergeStateFeedbackAndOdomFeedback (const teb_local_planner::PoseSE2 &odom_pose, const geometry_msgs::Twist &odom_twist, Eigen::Ref< Eigen::VectorXd > x) const override
	Merge custom state feedback with pose and twist feedback. More...

Public Member Functions inherited from mpc_local_planner::RobotDynamicsInterface
virtual void	getPoseSE2FromState (const Eigen::Ref< const Eigen::VectorXd > &x, teb_local_planner::PoseSE2 &pose) const
	Convert state vector to PoseSE2 object. More...

virtual void	getSteadyStateFromPoseSE2 (const teb_local_planner::PoseSE2 &pose, Eigen::Ref< Eigen::VectorXd > x) const
	Convert PoseSE2 to steady state. More...

virtual void	reset ()

Public Member Functions inherited from corbo::SystemDynamicsInterface
virtual double	getDeadTime () const

virtual void	getLinearA (const StateVector &x0, const ControlVector &u0, Eigen::MatrixXd &A) const

virtual void	getLinearB (const StateVector &x0, const ControlVector &u0, Eigen::MatrixXd &B) const

void	setLinearizationMethod (std::shared_ptr< FiniteDifferencesInterface > lin_method)

	SystemDynamicsInterface ()

virtual	~SystemDynamicsInterface ()=default

Additional Inherited Members
Public Types inherited from mpc_local_planner::BaseRobotSE2
using	Ptr = std::shared_ptr< BaseRobotSE2 >

Public Types inherited from mpc_local_planner::RobotDynamicsInterface
using	Ptr = std::shared_ptr< RobotDynamicsInterface >

Public Types inherited from corbo::SystemDynamicsInterface
typedef Eigen::VectorXd	ControlVector

typedef std::shared_ptr< SystemDynamicsInterface >	Ptr

typedef Eigen::VectorXd	StateVector

Detailed Description

Unicycle model.

This class implements the dynamics for a unicycle model which can be used e.g., for differential-drive robots. See [1] for a mathematical description and a figure.

[1] S. M. LaValle, Planning Algorithms, Cambridge University Press, 2006. (Chapter 13, http://planning.cs.uiuc.edu/)

See also: BaseRobotSE2 RobotDynamicsInterface corbo::SystemDynamicsInterface

Author: Christoph Rösmann (chris.nosp@m.toph.nosp@m..roes.nosp@m.mann.nosp@m.@tu-d.nosp@m.ortm.nosp@m.und.d.nosp@m.e)

Definition at line 66 of file unicycle_robot.h.

Constructor & Destructor Documentation

◆ UnicycleModel()

mpc_local_planner::UnicycleModel::UnicycleModel ( )

default

Default constructor.

Member Function Documentation

◆ dynamics()

void mpc_local_planner::UnicycleModel::dynamics	(	const Eigen::Ref< const StateVector > &	x,
		const Eigen::Ref< const ControlVector > &	u,
		Eigen::Ref< StateVector >	f
	)		const

inlineoverridevirtual

Implements mpc_local_planner::BaseRobotSE2.

Definition at line 99 of file unicycle_robot.h.

◆ getInputDimension()

int mpc_local_planner::UnicycleModel::getInputDimension ( ) const

inlineoverridevirtual

Implements mpc_local_planner::BaseRobotSE2.

Definition at line 96 of file unicycle_robot.h.

◆ getInstance()

SystemDynamicsInterface::Ptr mpc_local_planner::UnicycleModel::getInstance ( ) const

inlineoverridevirtual

Implements mpc_local_planner::BaseRobotSE2.

Definition at line 93 of file unicycle_robot.h.

◆ getTwistFromControl()

bool mpc_local_planner::UnicycleModel::getTwistFromControl	(	const Eigen::Ref< const Eigen::VectorXd > &	u,
		geometry_msgs::Twist &	twist
	)		const

inlineoverridevirtual

Convert control vector to twist message.

Convert the control vector to a twist message (containing velocity information) if possible.

Todo:: Maybe add current state x as optional input to allow for computing a twist out of the first state and control

Parameters

[in]	u	Reference to the control vector [getInputDimension() x 1]
[out]	twist	Reference to the twist message

Returns: true, if conversion was successful, false otherwise

Implements mpc_local_planner::RobotDynamicsInterface.

Definition at line 111 of file unicycle_robot.h.

The documentation for this class was generated from the following file:

unicycle_robot.h

Public Member Functions

Additional Inherited Members

Detailed Description

Constructor & Destructor Documentation

◆ UnicycleModel()

Member Function Documentation

◆ dynamics()

◆ getInputDimension()

◆ getInstance()

◆ getTwistFromControl()