Changed parameters for pantilt_control, s.t. now we have max_speed for tilt and for the pan servo.
Removed the parameters for velocity.

Included printf in pantilt_control for testing.