fixed forwardKin rotation code for planar manipulators.  throws an error now if the rotation is out of plane (as recommended by Twan).  IMU tests almost pass now
resolves the remaining imu test failures, handling the obnoxious sign flips if the view_axis is the negative of the axis angle