- FIX: re-enabled motor drive ans speedControl()

Signed-off-by: Dieter Niklaus <dieter.niklaus@gmx.net>