Fixed robot phasing through walls problem

The move update now checks whether the commanded update would move
inside the nearest obstacle and terminates the simulation. Also added
some exception handling to prevent program crashes when the robot
crashes. There is still a pesky problem with the maxmin_filter.
Fixed bad scan bug

Now if the filter throws away all the scan points I raise a custom
exception that skips the measure step.