Merge pull request #57 from wdlindmeier/developBill

Bug fixin' an' tweekin'
Fixed orientation for non linear movements. Added test sketch. Fixed some convergence blending issues