Robot can now align itself with the wall.

So far, there is no filtering on the LIDAR data, so it can really
only do it accurately in empty rooms.