The robot is not stopping anymore
A couple of bugs fixed