#include <special-euclidean.hpp>

Inheritance diagram for pinocchio::SpecialEuclideanOperationTpl< 2, _Scalar, _Options >:

Public Types
typedef Eigen::Matrix< Scalar, 2, 2, Options >	Matrix2

typedef VectorSpaceOperationTpl< 2, Scalar, Options >	R2_t

typedef CartesianProductOperation< R2_t, SO2_t >	R2crossSO2_t

typedef SpecialOrthogonalOperationTpl< 2, Scalar, Options >	SO2_t

typedef Eigen::Matrix< Scalar, 2, 1, Options >	Vector2

Public Types inherited from pinocchio::LieGroupBase< SpecialEuclideanOperationTpl< 2, _Scalar, _Options > >
enum

typedef Eigen::Matrix< Scalar, NQ, 1, Options >	ConfigVector_t

typedef int	Index

typedef Eigen::Matrix< Scalar, NV, NV, Options >	JacobianMatrix_t

typedef SpecialEuclideanOperationTpl< 2, _Scalar, _Options >	LieGroupDerived

typedef traits< LieGroupDerived >::Scalar	Scalar

typedef Eigen::Matrix< Scalar, NV, 1, Options >	TangentVector_t

Public Member Functions
template<ArgumentPosition arg, class ConfigL_t , class ConfigR_t , class JacobianOut_t >
void	dDifference_impl (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Eigen::MatrixBase< JacobianOut_t > &J) const

template<class Config_t , class Tangent_t , class JacobianIn_t , class JacobianOut_t >
void	dIntegrateTransport_dq_impl (const Eigen::MatrixBase< Config_t > &, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &J_out) const

template<class Config_t , class Tangent_t , class Jacobian_t >
void	dIntegrateTransport_dq_impl (const Eigen::MatrixBase< Config_t > &, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< Jacobian_t > &J) const

template<class Config_t , class Tangent_t , class JacobianIn_t , class JacobianOut_t >
void	dIntegrateTransport_dv_impl (const Eigen::MatrixBase< Config_t > &, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &J_out) const

template<class Config_t , class Tangent_t , class Jacobian_t >
void	dIntegrateTransport_dv_impl (const Eigen::MatrixBase< Config_t > &, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< Jacobian_t > &J) const

	PINOCCHIO_LIE_GROUP_TPL_PUBLIC_INTERFACE (SpecialEuclideanOperationTpl)

template<class Config_t >
void	random_impl (const Eigen::MatrixBase< Config_t > &qout) const

template<class ConfigL_t , class ConfigR_t , class ConfigOut_t >
void	randomConfiguration_impl (const Eigen::MatrixBase< ConfigL_t > &lower, const Eigen::MatrixBase< ConfigR_t > &upper, const Eigen::MatrixBase< ConfigOut_t > &qout) const

Public Member Functions inherited from pinocchio::LieGroupBase< SpecialEuclideanOperationTpl< 2, _Scalar, _Options > >
void	integrate (const Eigen::MatrixBase< ConfigIn_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< ConfigOut_t > &qout) const
	Integrate a joint's configuration with a tangent vector during one unit time duration. More...

void	integrateCoeffWiseJacobian (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Jacobian_t > &J) const
	Computes the Jacobian of the integrate operator around zero. More...

void	dIntegrate (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianOut_t > &J, AssignmentOperatorType op=SETTO) const
	Computes the Jacobian of a small variation of the configuration vector or the tangent vector into tangent space at identity. More...

void	dIntegrate (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianOut_t > &J, const ArgumentPosition arg, const AssignmentOperatorType op=SETTO) const
	Computes the Jacobian of a small variation of the configuration vector or the tangent vector into tangent space at identity. More...

void	dIntegrate_dq (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianOut_t > &J, const AssignmentOperatorType op=SETTO) const
	Computes the Jacobian of a small variation of the configuration vector into tangent space at identity. More...

void	dIntegrate_dq (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianIn_t > &Jin, int self, const Eigen::MatrixBase< JacobianOut_t > &Jout, const AssignmentOperatorType op=SETTO) const

void	dIntegrate_dq (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, int self, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &Jout, const AssignmentOperatorType op=SETTO) const

void	dIntegrate_dv (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianOut_t > &J, const AssignmentOperatorType op=SETTO) const
	Computes the Jacobian of a small variation of the tangent vector into tangent space at identity. More...

void	dIntegrate_dv (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, int self, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &Jout, const AssignmentOperatorType op=SETTO) const

void	dIntegrate_dv (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianIn_t > &Jin, int self, const Eigen::MatrixBase< JacobianOut_t > &Jout, const AssignmentOperatorType op=SETTO) const

void	dIntegrateTransport (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &Jout, const ArgumentPosition arg) const
	Transport a matrix from the terminal to the originate tangent space of the integrate operation, with respect to the configuration or the velocity arguments. More...

void	dIntegrateTransport (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< Jacobian_t > &J, const ArgumentPosition arg) const
	Transport in place a matrix from the terminal to the originate tangent space of the integrate operation, with respect to the configuration or the velocity arguments. More...

void	dIntegrateTransport_dq (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &Jout) const
	Transport a matrix from the terminal to the originate tangent space of the integrate operation, with respect to the configuration argument. More...

void	dIntegrateTransport_dq (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< Jacobian_t > &J) const
	Transport in place a matrix from the terminal to the originate tangent space of the integrate operation, with respect to the configuration argument. More...

void	dIntegrateTransport_dv (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &Jout) const
	Transport a matrix from the terminal to the originate tangent space of the integrate operation, with respect to the velocity argument. More...

void	dIntegrateTransport_dv (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< Jacobian_t > &J) const
	Transport in place a matrix from the terminal to the originate tangent space of the integrate operation, with respect to the velocity argument. More...

void	interpolate (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Scalar &u, const Eigen::MatrixBase< ConfigOut_t > &qout) const
	Interpolation between two joint's configurations. More...

void	normalize (const Eigen::MatrixBase< Config_t > &qout) const
	Normalize the joint configuration given as input. For instance, the quaternion must be unitary. More...

bool	isNormalized (const Eigen::MatrixBase< Config_t > &qin, const Scalar &prec=Eigen::NumTraits< Scalar >::dummy_precision()) const
	Check whether the input joint configuration is normalized. For instance, the quaternion must be unitary. More...

void	random (const Eigen::MatrixBase< Config_t > &qout) const
	Generate a random joint configuration, normalizing quaternions when necessary. More...

void	randomConfiguration (const Eigen::MatrixBase< ConfigL_t > &lower_pos_limit, const Eigen::MatrixBase< ConfigR_t > &upper_pos_limit, const Eigen::MatrixBase< ConfigOut_t > &qout) const
	Generate a configuration vector uniformly sampled among provided limits. More...

void	difference (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Eigen::MatrixBase< Tangent_t > &v) const
	Computes the tangent vector that must be integrated during one unit time to go from q0 to q1. More...

void	dDifference (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Eigen::MatrixBase< JacobianOut_t > &J) const
	Computes the Jacobian of the difference operation with respect to q0 or q1. More...

void	dDifference (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Eigen::MatrixBase< JacobianOut_t > &J, const ArgumentPosition arg) const
	Computes the Jacobian of the difference operation with respect to q0 or q1. More...

void	dDifference (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Eigen::MatrixBase< JacobianIn_t > &Jin, int self, const Eigen::MatrixBase< JacobianOut_t > &Jout, const AssignmentOperatorType op=SETTO) const

void	dDifference (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, int self, const Eigen::MatrixBase< JacobianIn_t > &Jin, const Eigen::MatrixBase< JacobianOut_t > &Jout, const AssignmentOperatorType op=SETTO) const

Scalar	squaredDistance (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1) const
	Squared distance between two joint configurations. More...

Scalar	distance (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1) const
	Distance between two configurations of the joint. More...

bool	isSameConfiguration (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Scalar &prec=Eigen::NumTraits< Scalar >::dummy_precision()) const
	Check if two configurations are equivalent within the given precision. More...

bool	operator== (const LieGroupBase &other) const

bool	operator!= (const LieGroupBase &other) const

ConfigVector_t	integrate (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Tangent_t > &v) const

ConfigVector_t	interpolate (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Scalar &u) const

ConfigVector_t	random () const

ConfigVector_t	randomConfiguration (const Eigen::MatrixBase< ConfigL_t > &lower_pos_limit, const Eigen::MatrixBase< ConfigR_t > &upper_pos_limit) const

TangentVector_t	difference (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1) const

void	dIntegrate_product_impl (const Config_t &q, const Tangent_t &v, const JacobianIn_t &Jin, JacobianOut_t &Jout, bool dIntegrateOnTheLeft, const ArgumentPosition arg, const AssignmentOperatorType op) const

void	dDifference_product_impl (const ConfigL_t &q0, const ConfigR_t &q1, const JacobianIn_t &Jin, JacobianOut_t &Jout, bool dDifferenceOnTheLeft, const AssignmentOperatorType op) const

void	interpolate_impl (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Scalar &u, const Eigen::MatrixBase< ConfigOut_t > &qout) const

void	normalize_impl (const Eigen::MatrixBase< Config_t > &qout) const

bool	isNormalized_impl (const Eigen::MatrixBase< Config_t > &qin, const Scalar &prec=Eigen::NumTraits< Scalar >::dummy_precision()) const

Scalar	squaredDistance_impl (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1) const

bool	isSameConfiguration_impl (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Scalar &prec) const

bool	isEqual_impl (const LieGroupBase &) const
	Default equality check. By default, two LieGroupBase of same type are considered equal. More...

bool	isDifferent_impl (const LieGroupBase &other) const

Index	nq () const

Index	nv () const
	Get dimension of Lie Group tangent space. More...

ConfigVector_t	neutral () const
	Get neutral element as a vector. More...

std::string	name () const
	Get name of instance. More...

SpecialEuclideanOperationTpl< 2, _Scalar, _Options > &	derived ()

const SpecialEuclideanOperationTpl< 2, _Scalar, _Options > &	derived () const

Static Public Member Functions
template<class ConfigL_t , class ConfigR_t , class Tangent_t >
static void	difference_impl (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Eigen::MatrixBase< Tangent_t > &d)

template<class Config_t , class Tangent_t , class JacobianOut_t >
static void	dIntegrate_dq_impl (const Eigen::MatrixBase< Config_t > &, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianOut_t > &J, const AssignmentOperatorType op=SETTO)

template<class Config_t , class Tangent_t , class JacobianOut_t >
static void	dIntegrate_dv_impl (const Eigen::MatrixBase< Config_t > &, const Eigen::MatrixBase< Tangent_t > &v, const Eigen::MatrixBase< JacobianOut_t > &J, const AssignmentOperatorType op=SETTO)

template<typename TangentVector , typename Matrix2Like , typename Vector2Like >
static void	exp (const Eigen::MatrixBase< TangentVector > &v, const Eigen::MatrixBase< Matrix2Like > &R, const Eigen::MatrixBase< Vector2Like > &t)

template<class ConfigIn_t , class Velocity_t , class ConfigOut_t >
static void	integrate_impl (const Eigen::MatrixBase< ConfigIn_t > &q, const Eigen::MatrixBase< Velocity_t > &v, const Eigen::MatrixBase< ConfigOut_t > &qout)

template<class Config_t , class Jacobian_t >
static void	integrateCoeffWiseJacobian_impl (const Eigen::MatrixBase< Config_t > &q, const Eigen::MatrixBase< Jacobian_t > &J)

template<class Config_t >
static bool	isNormalized_impl (const Eigen::MatrixBase< Config_t > &qin, const Scalar &prec)

template<class ConfigL_t , class ConfigR_t >
static bool	isSameConfiguration_impl (const Eigen::MatrixBase< ConfigL_t > &q0, const Eigen::MatrixBase< ConfigR_t > &q1, const Scalar &prec)

template<typename Matrix2Like , typename Vector2Like , typename JacobianOutLike >
static void	Jlog (const Eigen::MatrixBase< Matrix2Like > &R, const Eigen::MatrixBase< Vector2Like > &p, const Eigen::MatrixBase< JacobianOutLike > &J)

template<typename Matrix2Like , typename Vector2Like , typename TangentVector >
static void	log (const Eigen::MatrixBase< Matrix2Like > &R, const Eigen::MatrixBase< Vector2Like > &p, const Eigen::MatrixBase< TangentVector > &v)

static std::string	name ()

static ConfigVector_t	neutral ()

template<class Config_t >
static void	normalize_impl (const Eigen::MatrixBase< Config_t > &qout)

static Index	nq ()

static Index	nv ()
	Get dimension of Lie Group tangent space. More...

template<typename Matrix2Like , typename Vector2Like , typename Matrix3Like >
static void	toInverseActionMatrix (const Eigen::MatrixBase< Matrix2Like > &R, const Eigen::MatrixBase< Vector2Like > &t, const Eigen::MatrixBase< Matrix3Like > &M, const AssignmentOperatorType op)

Static Protected Member Functions
template<typename Matrix2Like , typename Vector2Like , typename Vector4Like >
static void	forwardKinematics (const Eigen::MatrixBase< Matrix2Like > &R, const Eigen::MatrixBase< Vector2Like > &t, const Eigen::MatrixBase< Vector4Like > &q)

Additional Inherited Members
Protected Member Functions inherited from pinocchio::LieGroupBase< SpecialEuclideanOperationTpl< 2, _Scalar, _Options > >
	LieGroupBase ()

	LieGroupBase (const LieGroupBase &)