BIG Changes to Module Priority + door spotting

Lots of offline changes on Teleop including fixing 2D map from Kinect
for door spotting, module priority handling, added long range IR sensors
for Teleop (but not quite done)