Filled out sensor ports in RobotMap.h, removing a bunch of //TODOs