Renamed variables and robot class ; added DSDisplay code ; implemented all robot functions except encoders