spatial6 1.2.0

Backend-agnostic 6D spatial vectors, transforms, and inertias for rigid-body dynamics
Documentation

spatial6

Backend-agnostic 6D spatial vectors, transforms, and inertias for rigid-body dynamics. Spatial coordinates store angular components before linear components.

[dependencies]
spatial6 = "1.2"

The crate provides MotionVector, ForceVector, MotionSubspace, SpatialTransform, RigidBodyInertia, and ArticulatedBodyInertia.

Feature Backend
builtin (default) Fixed Rust arrays
nalgebra Native nalgebra vectors and matrices
glam Native glam vectors and matrices
serde Serialize/Deserialize for all public types
No default features User-defined SpatialRepresentation

Enable optional backends with features = ["nalgebra"] or features = ["glam"]. Enable features = ["serde"] for serialization support; combined with nalgebra or glam, it also enables that backend's own serde integration so the underlying vector/matrix types serialize too.

See the API documentation for usage and conventions, and examples/ for worked algorithms built on these types: composite rigid-body inertia, inverse dynamics via the Recursive Newton-Euler Algorithm, and articulated-body inertia. Each of these three algorithms, plus a minimal single-rigid-body case, is worked through all three backends in a _nalgebra/_glam-suffixed sibling file (_builtin/no suffix is the default), so switching backends can be seen changing only the storage type, never the answer:

cargo run --example backend_builtin --no-default-features --features builtin
cargo run --example backend_nalgebra --no-default-features --features nalgebra
cargo run --example backend_glam --no-default-features --features glam

cargo run --example motion_subspace_builtin --no-default-features --features builtin
cargo run --example motion_subspace_nalgebra --no-default-features --features nalgebra
cargo run --example motion_subspace_glam --no-default-features --features glam

cargo run --example rnea_builtin --no-default-features --features builtin
cargo run --example rnea_nalgebra --no-default-features --features nalgebra
cargo run --example rnea_glam --no-default-features --features glam

cargo run --example composite_rigid_body_builtin --no-default-features --features builtin
cargo run --example composite_rigid_body_nalgebra --no-default-features --features nalgebra
cargo run --example composite_rigid_body_glam --no-default-features --features glam

cargo run --example articulated_inertia_builtin --no-default-features --features builtin
cargo run --example articulated_inertia_nalgebra --no-default-features --features nalgebra
cargo run --example articulated_inertia_glam --no-default-features --features glam

cargo run --example pose_chain_builtin --no-default-features --features builtin
cargo run --example pose_chain_nalgebra --no-default-features --features nalgebra
cargo run --example pose_chain_glam --no-default-features --features glam

to_pose_parts() returns the local-to-reference rotation Q and the local origin's position p in reference coordinates. Use from_pose_parts() to rebuild a transform from those owned parts; the stored transform rotation and translation remain the source-to-destination E/r representation.

let (q_local_to_reference, p_in_reference) = transform.to_pose_parts();
let restored = SpatialTransform::from_pose_parts(q_local_to_reference, p_in_reference);

ArticulatedBodyInertia represents the current articulated inertia, including the reduced symmetric operator produced by eliminating a joint acceleration under a specified joint force. The core reduction uses only backend-agnostic public operations:

let full = ArticulatedBodyInertia::try_from(&rigid)?;
let u = full.apply(&joint_motion);
let d = joint_motion.dot(&u);
assert!(d.is_finite() && d > 0.0);

let reduced = full.try_rank_one_updated(-1.0 / d, &u)?;
let child_in_parent = reduced.try_transformed(&child_to_parent)?;
let accumulated = parent.try_combined(&child_in_parent)?;

The aba_builtin example is a minimal fixed-base serial-chain ABA forward-dynamics walkthrough using the public ArticulatedBodyInertia API.

cargo run --example aba_builtin --no-default-features --features builtin

Contributing

Install Rust (stable, including rustfmt and Clippy) and uv, then run:

uv tool install pre-commit==4.6.2
pre-commit install
pre-commit run --all-files

Before submitting a change, run the same checks CI runs (which treats rustdoc warnings as errors):

cargo fmt --all -- --check
cargo clippy --all-targets --all-features -- -D warnings
cargo test
cargo test --no-default-features
cargo test --no-default-features --features nalgebra
cargo test --no-default-features --features glam
cargo test --features serde
cargo test --no-default-features --features serde
cargo test --all-features
cargo doc --no-deps --all-features

License

Copyright 2026 Daisuke Nagao.

Licensed under either the MIT License or the Apache License, Version 2.0, at your option (MIT OR Apache-2.0). Copyright and SPDX license information is recorded in Rust file headers.