Moved aspect ratio and tolerance constants into RobotMap, and re-added debug boolean for debugPrint