Updated RobotMap

- Updated robotmap
- cleaned up subsystem drive.