Fix error with colors
--> Change RGB to HSV (Better performance)
--> Servos and PIDs are commented