Fix for issue #10 (Fixation) issue #8 (Removed left in retreving 3D point) issue 9(store and restore context and not stopping the controller) and issue #7(goToPoseSync)