Cleaned up & organized RobotMap
Clean up everything