Got into reverse instead of stopping if getting to close to an object.
Added untested use of speed sensor to ensure the robot actualy moves