Move Logic

Moved logic from EntropyRobot to RobotDrive.