1#ifndef ROBOTOC_UNCONSTR_STATE_EQUATION_HPP_
2#define ROBOTOC_UNCONSTR_STATE_EQUATION_HPP_
45 const Eigen::VectorXd& q_prev,
46 const Eigen::VectorXd& v_prev,
62 const Eigen::VectorXd& q_prev,
63 const Eigen::VectorXd& v_prev,
88 const Eigen::VectorXd& v_prev,
The KKT matrix split into a time stage.
Definition: split_kkt_matrix.hpp:18
KKT residual split into each time stage.
Definition: split_kkt_residual.hpp:18
Solution to the optimal control problem split into a time stage.
Definition: split_solution.hpp:20
Definition: constraint_component_base.hpp:17
void evalUnconstrBackwardEuler(const double dt, const Eigen::VectorXd &q_prev, const Eigen::VectorXd &v_prev, const SplitSolution &s, SplitKKTResidual &kkt_residual)
Computes the residual in the state equation of backward Euler.
void linearizeUnconstrBackwardEulerTerminal(const double dt, const Eigen::VectorXd &q_prev, const Eigen::VectorXd &v_prev, const SplitSolution &s, SplitKKTMatrix &kkt_matrix, SplitKKTResidual &kkt_residual)
Linearizes the state equation of backward Euler at the terminal stage.
void linearizeUnconstrForwardEuler(const double dt, const SplitSolution &s, const SplitSolution &s_next, SplitKKTMatrix &kkt_matrix, SplitKKTResidual &kkt_residual)
Linearizes the state equation of forward Euler.
void linearizeUnconstrForwardEulerTerminal(const SplitSolution &s, SplitKKTResidual &kkt_residual)
Linearizes the state equation of forward Euler.
void linearizeUnconstrBackwardEuler(const double dt, const Eigen::VectorXd &q_prev, const Eigen::VectorXd &v_prev, const SplitSolution &s, const SplitSolution &s_next, SplitKKTMatrix &kkt_matrix, SplitKKTResidual &kkt_residual)
Linearizes the state equation of backward Euler.
void evalUnconstrForwardEuler(const double dt, const SplitSolution &s, const SplitSolution &s_next, SplitKKTResidual &kkt_residual)
Computes the residual in the state equation of forward Euler.