Extend gaze controller
The low level gaze controller currently computes the desired head joint angles based on the "atan2-IK". Then, these target joint angles are just given to a position controller.
This approach has several limitations:
- The velocity of the head movement cannot be controlled. Based on the importance of the gaze target, this should be variable.
- The joints are controlled individually. One would expect a holistic behavior such that the velocity of both joints are coupled.