pub type SpatialVec6 = [f64; 6];
6D spatial motion or force vector [ang_0, ang_1, ang_2, lin_0, lin_1, lin_2].
[ang_0, ang_1, ang_2, lin_0, lin_1, lin_2]