minor modif in RPY_to_mat