Fixed commands so that they now match previous RobotBuilder version
Converted the RobotMap class to use the Team 254 constants class.