Struct URDFChain 

pub struct URDFChain<const N: usize, F: FKScalar = f32> { /* private fields */ }

FK chain using exact URDF joint transforms.

Accumulation works directly on columns:

1. Translation: t += fx·c0 + fy·c1 + fz·c2
2. Fixed rotation: (c0,c1,c2) = (c0,c1,c2) * fixed_rot
3. Joint rotation: 2D rotation on the appropriate column pair

When fixed_rot is identity (RPY = 0, the common case), step 2 is skipped entirely, making per-joint cost a single 2D column rotation plus translation — cheaper than DH.

Implementations

impl<const N: usize> URDFChain<N, f32>

pub const fn new(joints: [URDFJoint; N]) -> Result<Self, URDFBuildError>

Build a chain from exactly N actuated (revolute) joints. Returns URDFBuildError::JointTypeMismatch if any entry is Fixed or Prismatic. For a slice that mixes fixed joints in, use URDFChain::from_urdf instead.

pub const fn from_urdf(joints: &[URDFJoint]) -> Result<Self, URDFBuildError>

Build a chain from a flat URDF joint list (any mix of Fixed, Revolute, and/or Prismatic). The list must describe a single branch in parent→child order.

• Leading Fixed joints become the prefix (applied before joint 0).
• Trailing Fixed joints become the suffix (applied after the last actuated joint).
• Fixed joints sandwiched between actuated joints are folded into the origin of the next actuated joint so the kinematics are preserved exactly.
• The number of Revolute joints must equal N.

Returns URDFBuildError::JointTypeMismatch if a Prismatic joint appears (not handled by URDFChain itself — wrap the result in PrismaticFK for a prismatic joint at the start or end), or URDFBuildError::RevoluteCountMismatch if the revolute count doesn’t match N.

pub const fn with_fixed_prefix( self, joints: &[URDFJoint], ) -> Result<Self, URDFBuildError>

Bake a sequence of URDF fixed-joint origins (parent→child order) into the base side of the chain.

pub const fn with_fixed_suffix( self, joints: &[URDFJoint], ) -> Result<Self, URDFBuildError>

Bake a sequence of URDF fixed-joint origins (parent→child order) into the tool side of the chain.

pub const fn with_fixed_joints( self, prefix: &[URDFJoint], suffix: &[URDFJoint], ) -> Result<Self, URDFBuildError>

Convenience: set both a fixed-joint prefix and suffix in one call.

impl<const N: usize> URDFChain<N, f64>

pub const fn new_f64(joints: [URDFJoint; N]) -> Result<Self, URDFBuildError>

const-evaluable f64 analogue of URDFChain::<N, f32>::new.

pub const fn from_urdf_f64(joints: &[URDFJoint]) -> Result<Self, URDFBuildError>

const-evaluable f64 analogue of URDFChain::<N, f32>::from_urdf.

pub const fn with_fixed_prefix_f64( self, joints: &[URDFJoint], ) -> Result<Self, URDFBuildError>

const-evaluable f64 analogue of URDFChain::<N, f32>::with_fixed_prefix.

pub const fn with_fixed_suffix_f64( self, joints: &[URDFJoint], ) -> Result<Self, URDFBuildError>

const-evaluable f64 analogue of URDFChain::<N, f32>::with_fixed_suffix.

pub const fn with_fixed_joints_f64( self, prefix: &[URDFJoint], suffix: &[URDFJoint], ) -> Result<Self, URDFBuildError>

Convenience: set both a fixed-joint prefix and suffix in one call (f64).

Trait Implementations

impl<const N: usize, F: Clone + FKScalar> Clone for URDFChain<N, F>

fn clone(&self) -> URDFChain<N, F>

Returns a duplicate of the value.

fn clone_from(&mut self, source: &Self)

Performs copy-assignment from source.

impl<const N: usize, F: Debug + FKScalar> Debug for URDFChain<N, F>

fn fmt(&self, f: &mut Formatter<'_>) -> Result

Formats the value using the given formatter.

impl<const N: usize, F: FKScalar> FKChain<N, F> for URDFChain<N, F>

type Error = DekeError

fn base_tf(&self) -> F::AAffine3

Configuration-independent transform from the robot’s base frame to the world frame. Defaults to identity; wrappers that install a static prefix (e.g. TransformedFK with a prefix set, or URDFChain with fixed leading joints baked in) override this so downstream consumers (collision validators, visualizers) can place the static base body at the correct pose.

fn fk(&self, q: &SRobotQ<N, F>) -> Result<[F::AAffine3; N], Self::Error>

fn fk_end(&self, q: &SRobotQ<N, F>) -> Result<F::AAffine3, Self::Error>

fn all_fk( &self, q: &SRobotQ<N, F>, ) -> Result<(F::AAffine3, [F::AAffine3; N], F::AAffine3), Self::Error>

Compute base transform, per-link frames, and the end-effector frame in one call. Consumers that need all three (collision validators, visualizers) should prefer this over invoking base_tf, fk, and fk_end separately.

fn joint_axes_positions( &self, q: &SRobotQ<N, F>, ) -> Result<([F::AVec3; N], [F::AVec3; N], F::AVec3), Self::Error>

Returns joint rotation axes and axis-origin positions in world frame at configuration q, plus the end-effector position.

fn dof(&self) -> usize

fn max_reach(&self) -> Result<F, Self::Error>

Theoretical maximum reach: sum of link lengths (upper bound, ignores joint limits).

fn jacobian(&self, q: &SRobotQ<N, F>) -> Result<[[F; N]; 6], Self::Error>

Geometric Jacobian (6×N) at configuration q. Rows 0–2: linear velocity, rows 3–5: angular velocity.

fn jacobian_dot( &self, q: &SRobotQ<N, F>, qdot: &SRobotQ<N, F>, ) -> Result<[[F; N]; 6], Self::Error>

First time-derivative of the geometric Jacobian.

fn jacobian_ddot( &self, q: &SRobotQ<N, F>, qdot: &SRobotQ<N, F>, qddot: &SRobotQ<N, F>, ) -> Result<[[F; N]; 6], Self::Error>

Second time-derivative of the geometric Jacobian.

impl From<URDFChain<1>> for DynamicURDFChain

fn from(chain: URDFChain<1>) -> Self

Converts to this type from the input type.

impl From<URDFChain<2>> for DynamicURDFChain

fn from(chain: URDFChain<2>) -> Self

Converts to this type from the input type.

impl From<URDFChain<3>> for DynamicURDFChain

fn from(chain: URDFChain<3>) -> Self

Converts to this type from the input type.

impl From<URDFChain<4>> for DynamicURDFChain

fn from(chain: URDFChain<4>) -> Self

Converts to this type from the input type.

impl From<URDFChain<5>> for DynamicURDFChain

fn from(chain: URDFChain<5>) -> Self

Converts to this type from the input type.

impl From<URDFChain<6>> for DynamicURDFChain

fn from(chain: URDFChain<6>) -> Self

Converts to this type from the input type.

impl From<URDFChain<7>> for DynamicURDFChain

fn from(chain: URDFChain<7>) -> Self

Converts to this type from the input type.

impl From<URDFChain<8>> for DynamicURDFChain

fn from(chain: URDFChain<8>) -> Self

Converts to this type from the input type.

impl<const N: usize> From<URDFChain<N>> for URDFChain<N, f64>

fn from(c: URDFChain<N, f32>) -> Self

Converts to this type from the input type.

impl<const N: usize> From<URDFChain<N, f64>> for URDFChain<N, f32>

fn from(c: URDFChain<N, f64>) -> Self

Converts to this type from the input type.