add the gradient of rpydot2axisvel