Rev 6.0.0

NOTE you can go back to rev 5.5.1 which is a stable one uncommenting some instructions and using a thread to simulate the encoder (still used but with separate synch semaphores).

Merged Encoder normal and debug modes.

Added a command to go/exit from debug mode