#include <quadratic_state_cost.h>

Inheritance diagram for corbo::QuadraticStateCost:

Public Member Functions
bool	checkParameters (int state_dim, int control_dim, std::stringstream *issues) const override

void	computeIntegralStateControlTerm (int k, const Eigen::Ref< const Eigen::VectorXd > &x_k, const Eigen::Ref< const Eigen::VectorXd > &u_k, Eigen::Ref< Eigen::VectorXd > cost) const override

void	computeNonIntegralStateTerm (int k, const Eigen::Ref< const Eigen::VectorXd > &x_k, Eigen::Ref< Eigen::VectorXd > cost) const override

StageCost::Ptr	getInstance () const override
	Return a newly created shared instance of the implemented class. More...

int	getIntegralStateControlTermDimension (int k) const override

int	getNonIntegralStateTermDimension (int k) const override

bool	hasIntegralTerms (int k) const override

bool	hasNonIntegralTerms (int k) const override

bool	isLsqFormNonIntegralStateTerm (int k) const override

	QuadraticStateCost ()

	QuadraticStateCost (const Eigen::Ref< const Eigen::MatrixXd > &Q, bool integral_form, bool lsq_form=false)

void	setIntegralForm (bool integral_form)

void	setLsqForm (bool lsq_form)

bool	setWeightQ (const Eigen::Ref< const Eigen::MatrixXd > &Q)

bool	setWeightQ (const Eigen::DiagonalMatrix< double, -1 > &Q)

bool	update (int n, double t, ReferenceTrajectoryInterface &xref, ReferenceTrajectoryInterface &uref, ReferenceTrajectoryInterface sref, bool single_dt, const Eigen::VectorXd &x0, StagePreprocessor::Ptr stage_preprocessor, const std::vector< double > &dts, const DiscretizationGridInterface ) override

Public Member Functions inherited from corbo::StageFunction
virtual void	computeConcatenatedNonIntegralStateControlTerms (int k, const Eigen::Ref< const Eigen::VectorXd > &x_k, const Eigen::Ref< const Eigen::VectorXd > &u_k, double dt_k, Eigen::Ref< Eigen::VectorXd > cost, bool lsq_mode=false) const

virtual void	computeConcatenatedNonIntegralStateTerms (int k, const Eigen::Ref< const Eigen::VectorXd > &x_k, const Eigen::Ref< const Eigen::VectorXd > &u_k, double dt_k, Eigen::Ref< Eigen::VectorXd > cost, bool lsq_mode=false) const

virtual void	computeNonIntegralControlDeviationTerm (int k, const Eigen::Ref< const Eigen::VectorXd > &u_k, const Eigen::Ref< const Eigen::VectorXd > &u_prev, double dt_prev, Eigen::Ref< Eigen::VectorXd > cost) const

virtual void	computeNonIntegralControlTerm (int k, const Eigen::Ref< const Eigen::VectorXd > &u_k, Eigen::Ref< Eigen::VectorXd > cost) const

virtual void	computeNonIntegralDtTerm (int k, double dt, Eigen::Ref< Eigen::VectorXd > cost) const

virtual void	computeNonIntegralStateControlDtTerm (int k, const Eigen::Ref< const Eigen::VectorXd > &x_k, const Eigen::Ref< const Eigen::VectorXd > &u_k, double dt_k, Eigen::Ref< Eigen::VectorXd > cost) const

virtual void	computeNonIntegralStateControlTerm (int k, const Eigen::Ref< const Eigen::VectorXd > &x_k, const Eigen::Ref< const Eigen::VectorXd > &u_k, Eigen::Ref< Eigen::VectorXd > cost) const

virtual void	computeNonIntegralStateDtTerm (int k, const Eigen::Ref< const Eigen::VectorXd > &x_k, double dt_k, Eigen::Ref< Eigen::VectorXd > cost) const
	computeNonIntegralStateDtTerm: warning: currently only supported for full discretization More...

virtual int	getConcatenatedNonIntegralStateControlTermDimension (int k, bool lsq_mode=false) const

virtual int	getConcatenatedNonIntegralStateTermDimension (int k, bool lsq_mode=false) const

virtual int	getNonIntegralControlDeviationTermDimension (int k) const

virtual int	getNonIntegralControlTermDimension (int k) const

virtual int	getNonIntegralDtTermDimension (int k) const

virtual int	getNonIntegralStateControlDtTermDimension (int k) const

virtual int	getNonIntegralStateControlTermDimension (int k) const

virtual int	getNonIntegralStateDtTermDimension (int k) const

virtual bool	isLinearNonIntegralControlTerm (int k) const

virtual bool	isLinearNonIntegralDtTerm (int k) const

virtual bool	isLinearNonIntegralStateTerm (int k) const

virtual bool	isLsqFormNonIntegralControlTerm (int k) const

virtual bool	isLsqFormNonIntegralDtTerm (int k) const

virtual	~StageFunction ()=default
	Default destructor. More...

Protected Attributes
bool	_diagonal_mode = false

bool	_diagonal_mode_intentionally = false

bool	_integral_form = false

bool	_lsq_form = true

Eigen::MatrixXd	_Q

Eigen::DiagonalMatrix< double, -1 >	_Q_diag

Eigen::DiagonalMatrix< double, -1 >	_Q_diag_sqrt

Eigen::MatrixXd	_Q_sqrt

const ReferenceTrajectoryInterface *	_x_ref = nullptr

bool	_zero_x_ref = false

Additional Inherited Members
Public Types inherited from corbo::StageCost
using	ConstPtr = std::shared_ptr< const StageCost >

using	Ptr = std::shared_ptr< StageCost >

Public Types inherited from corbo::StageFunction
using	ConstPtr = std::shared_ptr< const StageFunction >

using	Ptr = std::shared_ptr< StageFunction >

Detailed Description

Definition at line 35 of file quadratic_state_cost.h.

Constructor & Destructor Documentation

◆ QuadraticStateCost() [1/2]

corbo::QuadraticStateCost::QuadraticStateCost ( )

inline

Definition at line 38 of file quadratic_state_cost.h.

◆ QuadraticStateCost() [2/2]

corbo::QuadraticStateCost::QuadraticStateCost	(	const Eigen::Ref< const Eigen::MatrixXd > &	Q,
		bool	integral_form,
		bool	lsq_form = `false`
	)

inline

Definition at line 40 of file quadratic_state_cost.h.

Member Function Documentation

◆ checkParameters()

bool corbo::QuadraticStateCost::checkParameters	(	int	state_dim,
		int	control_dim,
		std::stringstream *	issues
	)		const

overridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 133 of file quadratic_state_cost.cpp.

◆ computeIntegralStateControlTerm()

void corbo::QuadraticStateCost::computeIntegralStateControlTerm	(	int	k,
		const Eigen::Ref< const Eigen::VectorXd > &	x_k,
		const Eigen::Ref< const Eigen::VectorXd > &	u_k,
		Eigen::Ref< Eigen::VectorXd >	cost
	)		const

overridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 108 of file quadratic_state_cost.cpp.

◆ computeNonIntegralStateTerm()

void corbo::QuadraticStateCost::computeNonIntegralStateTerm	(	int	k,
		const Eigen::Ref< const Eigen::VectorXd > &	x_k,
		Eigen::Ref< Eigen::VectorXd >	cost
	)		const

overridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 65 of file quadratic_state_cost.cpp.

◆ getInstance()

StageCost::Ptr corbo::QuadraticStateCost::getInstance ( ) const

inlineoverridevirtual

Return a newly created shared instance of the implemented class.

Implements corbo::StageCost.

Definition at line 46 of file quadratic_state_cost.h.

◆ getIntegralStateControlTermDimension()

int corbo::QuadraticStateCost::getIntegralStateControlTermDimension ( int k ) const

inlineoverridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 52 of file quadratic_state_cost.h.

◆ getNonIntegralStateTermDimension()

int corbo::QuadraticStateCost::getNonIntegralStateTermDimension ( int k ) const

inlineoverridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 51 of file quadratic_state_cost.h.

◆ hasIntegralTerms()

bool corbo::QuadraticStateCost::hasIntegralTerms ( int k ) const

inlineoverridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 48 of file quadratic_state_cost.h.

◆ hasNonIntegralTerms()

bool corbo::QuadraticStateCost::hasNonIntegralTerms ( int k ) const

inlineoverridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 49 of file quadratic_state_cost.h.

◆ isLsqFormNonIntegralStateTerm()

bool corbo::QuadraticStateCost::isLsqFormNonIntegralStateTerm ( int k ) const

inlineoverridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 54 of file quadratic_state_cost.h.

◆ setIntegralForm()

void corbo::QuadraticStateCost::setIntegralForm ( bool integral_form )

inline

Definition at line 59 of file quadratic_state_cost.h.

◆ setLsqForm()

void corbo::QuadraticStateCost::setLsqForm ( bool lsq_form )

inline

Definition at line 58 of file quadratic_state_cost.h.

◆ setWeightQ() [1/2]

bool corbo::QuadraticStateCost::setWeightQ ( const Eigen::Ref< const Eigen::MatrixXd > & Q )

Definition at line 33 of file quadratic_state_cost.cpp.

◆ setWeightQ() [2/2]

bool corbo::QuadraticStateCost::setWeightQ ( const Eigen::DiagonalMatrix< double, -1 > & Q )

Definition at line 56 of file quadratic_state_cost.cpp.

◆ update()

bool corbo::QuadraticStateCost::update	(	int	n,
		double	t,
		ReferenceTrajectoryInterface &	xref,
		ReferenceTrajectoryInterface &	uref,
		ReferenceTrajectoryInterface *	sref,
		bool	single_dt,
		const Eigen::VectorXd &	x0,
		StagePreprocessor::Ptr	stage_preprocessor,
		const std::vector< double > &	dts,
		const DiscretizationGridInterface *
	)

inlineoverridevirtual

Reimplemented from corbo::StageFunction.

Definition at line 65 of file quadratic_state_cost.h.

Member Data Documentation

◆ _diagonal_mode

bool corbo::QuadraticStateCost::_diagonal_mode = false

protected

Definition at line 94 of file quadratic_state_cost.h.

◆ _diagonal_mode_intentionally

bool corbo::QuadraticStateCost::_diagonal_mode_intentionally = false

protected

Definition at line 95 of file quadratic_state_cost.h.

◆ _integral_form

bool corbo::QuadraticStateCost::_integral_form = false

protected

Definition at line 97 of file quadratic_state_cost.h.

◆ _lsq_form

bool corbo::QuadraticStateCost::_lsq_form = true

protected

Definition at line 96 of file quadratic_state_cost.h.

◆ _Q

Eigen::MatrixXd corbo::QuadraticStateCost::_Q

protected

Definition at line 91 of file quadratic_state_cost.h.

◆ _Q_diag

Eigen::DiagonalMatrix<double, -1> corbo::QuadraticStateCost::_Q_diag

protected

Definition at line 93 of file quadratic_state_cost.h.

◆ _Q_diag_sqrt

Eigen::DiagonalMatrix<double, -1> corbo::QuadraticStateCost::_Q_diag_sqrt

protected

Definition at line 92 of file quadratic_state_cost.h.

◆ _Q_sqrt

Eigen::MatrixXd corbo::QuadraticStateCost::_Q_sqrt

protected

Definition at line 90 of file quadratic_state_cost.h.

◆ _x_ref

const ReferenceTrajectoryInterface* corbo::QuadraticStateCost::_x_ref = nullptr

protected

Definition at line 99 of file quadratic_state_cost.h.

◆ _zero_x_ref

bool corbo::QuadraticStateCost::_zero_x_ref = false

protected

Definition at line 100 of file quadratic_state_cost.h.

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

Public Member Functions

Protected Attributes

Additional Inherited Members

Detailed Description

Constructor & Destructor Documentation

◆ QuadraticStateCost() [1/2]

◆ QuadraticStateCost() [2/2]

Member Function Documentation

◆ checkParameters()

◆ computeIntegralStateControlTerm()

◆ computeNonIntegralStateTerm()

◆ getInstance()

◆ getIntegralStateControlTermDimension()

◆ getNonIntegralStateTermDimension()

◆ hasIntegralTerms()

◆ hasNonIntegralTerms()

◆ isLsqFormNonIntegralStateTerm()

◆ setIntegralForm()

◆ setLsqForm()

◆ setWeightQ() [1/2]

◆ setWeightQ() [2/2]

◆ update()

Member Data Documentation

◆ _diagonal_mode

◆ _diagonal_mode_intentionally

◆ _integral_form

◆ _lsq_form

◆ _Q

◆ _Q_diag

◆ _Q_diag_sqrt

◆ _Q_sqrt

◆ _x_ref

◆ _zero_x_ref