Load URDF format and create k::Chain
k::Chain
Useful function to deal about ‘Links’ of URDF
Returns nalgebra::UnitQuaternion from f64 array
Returns nalgebra::Translation3 from f64 array