Fixed orientation for non linear movements. Added test sketch. Fixed some convergence blending issues
Merge pull request #58 from wdlindmeier/developBill

Fixed orientation for non linear movements. Added test sketch. Fixed som...