converted everything to local angles in an attempt to match the analytic formulas in the 'Introduction to Robotics' paper