Fix JointTest (free joint translation is in fp coordinate).
Remvoe Rev{X,Y,Z} and Prism{X,Y,Z}. Use Rev and Prism intead with an axis parameter.