pub fn vector6_to_joints(v: Vector6<f64>) -> Joints
Converts nalgebra::Vector6<f64> to Joints ([f64; 6])
nalgebra::Vector6<f64>