[ctrlLib/math]: dcm2rpy() modifed / rpy2dcm() fixed