declare variables where they are of main use.
move timeval_substract to a common unit (for sharing this function with future developments).
new task to control head position to the ball.