KPT: moved all control to xbox controller
Implementing PID controller for azimuth. It doesn't work.