Laser works a lot better now, and is much cleaner code. One small bug remains about it in the robot mode.