Make it do some filtering on LIDAR data.

Now the robot can align itself better, but still not perfectly.
Also fixed some logging bugs and revised the deploy script.