fixed revolute joint issue, added kineamtics, angle representation conversions, and some new ways to control the arm