Axis angle compensation code added.  Briefly tested in XY plane.  Seems to work.  More testing is probably needed...