Implemented real dual drive mode

Dual Drive kind of works now except for the speed which gets ignored
(robot just turns always at the same speed)