Struct Robot 

pub struct Robot<M: RobotBasic> {
    pub constraints: Constraints,
    /* private fields */
}

User-facing robot wrapper that owns constraint storage and conversion logic.

Design role

Robot<M> bridges robot-side physical constraints and solver-side normalized inequalities. Internally it owns Constraints, but exposes higher-level APIs with physical semantics.

Why prefer this over direct Constraints

For most applications, Robot is the recommended entry because it provides domain-meaningful methods (Robot::with_axial_velocity, Robot::with_axial_acceleration, Robot::with_axial_jerk, torque constraints) and enforces common contracts.

Trait requirements by solver family

• Topp*Problem: model type M only needs RobotBasic.
• Copp*Problem: model type M must implement RobotTorque.

If you do not have a real inverse-dynamics model yet, use usize as a placeholder implementing RobotTorque (tau = ddq).

Fields

constraints: Constraints

Shared station-indexed constraint buffer used by TOPP/COPP solvers.

Implementations

impl<M: RobotBasic> Robot<M>

pub fn new(model: M) -> Self

Construct a robot wrapper with default constraint-buffer capacity.

Parameters

• model: concrete robot model implementing RobotBasic.

pub fn with_capacity(model: M, capacity: usize) -> Self

Construct a robot wrapper with explicit initial constraint capacity.

Parameters

• model: concrete robot model implementing RobotBasic. Pass a usize value for a dimension-only placeholder that also satisfies RobotTorque with a trivial identity dynamics (tau = ddq), which is convenient for testing or applications without real inverse dynamics.
• capacity: pre-allocated number of station columns in the internal circular constraint buffer. Setting this to the expected number of path samples (e.g. n) avoids re-allocations during constraint ingestion. Use Robot::new when the size is unknown up-front.

pub fn dim(&self) -> usize

Get robot dimension / DoF.

pub fn with_s<T: AsInputMatrix1D + ?Sized>( &mut self, s_new: &T, ) -> Result<(), ConstraintError>

Append a new station segment into the internal constraint buffer.

Parameters

• s_new: station samples accepted as 1D slice or matrix view.

Errors

Propagates monotonicity/range errors from Constraints::with_s.

pub fn with_q( &mut self, q_new: &InputMatrix<'_>, dq_new: &InputMatrix<'_>, ddq_new: &InputMatrix<'_>, dddq_new: Option<&InputMatrix<'_>>, idx_s: usize, ) -> Result<(), ConstraintError>

Write path derivatives over interval starting at idx_s.

Parameters

• q_new, dq_new, ddq_new: required derivative matrices.
• dddq_new: optional third derivative matrix.
• idx_s: global start station id.

Errors

Forwards shape/range errors from Constraints::with_q.

pub fn with_axial_velocity<T1, T2>( &mut self, axial_velocity_max: T1, axial_velocity_min: T2, start_idx_s: usize, ) -> Result<(), ConstraintError>

where T1: UpperBound, T2: UpperBound,

Add axial velocity limits on interval starting at start_idx_s.

Input semantics

Enforces per-axis bounds: axial_velocity_min < \dot{q} < axial_velocity_max.

Mapping

Converts velocity bounds into first-order path-speed limits on a = \dot{s}^2, then fuses into amax.

Errors

• ConstraintError::NoMatchDimensions
• ConstraintError::OutOfSBounds
• ConstraintError::NoGivenQInfo
• ConstraintError::InvalidSignedBounds when max/min signs are invalid

pub fn with_axial_acceleration<T1, T2>( &mut self, axial_acceleration_max: T1, axial_acceleration_min: T2, start_idx_s: usize, ) -> Result<(), ConstraintError>

where T1: UpperBound, T2: UpperBound,

Add axial acceleration limits on interval starting at start_idx_s.

Input semantics

Enforces per-axis bounds: axial_acceleration_min < \ddot{q} < axial_acceleration_max.

Mapping

Generates second-order rows: acc_a * a + acc_b * b <= acc_max, where (a,b) are path-speed variables.

Errors

• ConstraintError::NoMatchDimensions
• ConstraintError::OutOfSBounds
• ConstraintError::NoGivenQInfo
• ConstraintError::InvalidSignedBounds

pub fn with_axial_jerk<T1, T2>( &mut self, axial_jerk_max: T1, axial_jerk_min: T2, start_idx_s: usize, ) -> Result<(), ConstraintError>

where T1: UpperBound, T2: UpperBound,

Add axial jerk limits on interval starting at start_idx_s.

Input semantics

Enforces per-axis bounds: axial_jerk_min < \dddot{q} < axial_jerk_max.

Mapping

Generates third-order rows used by TOPP3/COPP3: sqrt(a) * (jerk_a*a + jerk_b*b + jerk_c*c + jerk_d) <= jerk_max.

Errors

• ConstraintError::NoMatchDimensions
• ConstraintError::OutOfSBounds
• ConstraintError::NoGivenQInfo (needs q/dq/ddq/dddq)
• ConstraintError::InvalidSignedBounds

impl<M: RobotTorque> Robot<M>

pub fn with_axial_torque<T1, T2>( &mut self, axial_torque_max: T1, axial_torque_min: T2, start_idx_s: usize, ) -> Result<(), ConstraintError>

where T1: UpperBound, T2: UpperBound,

Add axial torque limits on interval starting at start_idx_s.

Input semantics

Enforces per-axis bounds: axial_torque_min < tau < axial_torque_max.

Mapping

Using inverse dynamics, torque limits are transformed into second-order rows on (a,b) and appended to the constraint buffer.

Errors

• ConstraintError::NoMatchDimensions
• ConstraintError::OutOfSBounds
• ConstraintError::NoGivenQInfo
• ConstraintError::InvalidSignedBounds