spatial6 1.1.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.1"

The crate provides MotionVector, ForceVector, 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 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.