gaze task implemented and working with arucos
working solution, tested on robot.