Commands parser implemented.

Small cleanups in registers map.
Change speed works with EEPROM now.