Collision detection is much better now
merged with Max's newest localizer (collision detection, sonar, robot-percieved IR