deke-linear 2.0.0

Constant-TCP-speed Cartesian polyline following for serial manipulators.
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42

use deke_types::DekeError;

/// Errors surfaced by the constant-speed Cartesian follower.
#[derive(Debug, thiserror::Error)]
pub enum LinearError {
    #[error("need at least 2 poses to define a path, got {0}")]
    TooFewPoses(usize),
    #[error("run {run}: every vertex coincides — nothing to follow")]
    DegenerateRun { run: usize },
    #[error("run {run}: Cartesian pose at arc length {s:.4} m has no reachable IK solution")]
    Unreachable { run: usize, s: f64 },
    #[error(
        "run {run}: every reachable configuration at arc length {s:.4} m is rejected by the validator (obstructed)"
    )]
    Obstructed { run: usize, s: f64 },
    #[error("run {run}: could not route a continuous joint track through the IK candidates")]
    NoContinuousTrack { run: usize },
    #[error(
        "retimer stalled on run {run} near arc length {s:.4} m (path likely passes through a singularity)"
    )]
    Stalled { run: usize, s: f64 },
    #[error(
        "run {run}: holding constant TCP speed forbids the interior dip at arc length {s:.4} m (max feasible {feasible_speed:.4} m/s < commanded {commanded:.4} m/s)"
    )]
    SpeedDipRequired {
        run: usize,
        s: f64,
        feasible_speed: f64,
        commanded: f64,
    },
    #[error(transparent)]
    Deke(#[from] DekeError),
}

impl From<LinearError> for DekeError {
    fn from(e: LinearError) -> Self {
        match e {
            LinearError::Deke(d) => d,
            other => DekeError::RetimerFailed(other.to_string()),
        }
    }
}