Improved PID regulator for rotation command
Started implementation of PID regulator settings