updated SE3D with more clearer and safer quaternions, added conversion to rpy in URDF format
updated SE3D with more clearer and safer quaternions, added conversion to rpy in URDF format

eruffaldi/stereocalib