Add navigation code.

So far, I can determine the dimensions of the room the robot is
in, and figure out the rotation of the robot relative to the wall.