Buggy MoveHandStraight function

[Softwaretom007]

Hello,
i have issue with function MoveHandStraight. When manipulator haven't any rotation transformation defined in XML, function is working well. But if I define some rotation (small changes like 2deg), function fails to finish on same data. Occasionally is working (like 1 % of total tests - tests when is no rotation transform). I must rotate manipulator geometries inside *.stl to get MoveHandStraight work.

I assume that local direction must be aligned to global in some way.