Changed rotation speed to constant speed.
Adaption from A-Star Route to driving commands implemented (Warning: not tested yet. commit to pull !!!!!)
changed map
right route gets returned
tweeking and bugfixing