Improved Collision Detection

The Robot will no longer be stuck when it hits a wall - it can now move
backwards away from the wall after hitting it.