1#ifndef ROBOTOC_SWITCHING_CONSTRAINT_HPP_
2#define ROBOTOC_SWITCHING_CONSTRAINT_HPP_
29 const double dt1,
const double dt2,
Impact status of robot model. Wrapper of ContactStatus to treat impacts.
Definition: impact_status.hpp:21
Dynamics and kinematics model of robots. Wraps pinocchio::Model and pinocchio::Data....
Definition: robot.hpp:32
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
Data for the switching constraint.
Definition: switching_constraint_data.hpp:13
Definition: constraint_component_base.hpp:17
void linearizeSwitchingConstraint(Robot &robot, const ImpactStatus &impact_status, SwitchingConstraintData &data, const double dt1, const double dt2, const SplitSolution &s, SplitKKTMatrix &kkt_matrix, SplitKKTResidual &kkt_residual)
Linearizes the switching constraint, i.e., the contact position constraint.
void evalSwitchingConstraint(Robot &robot, const ImpactStatus &impact_status, SwitchingConstraintData &data, const double dt1, const double dt2, const SplitSolution &s, SplitKKTResidual &kkt_residual)
Computes the residual in the switching constraint, i.e., the contact position constraint.