add a test for rpydot2angularvel and rpydot2angularvelocity