I changed the ports to go through the RobotMap class.
I added comments to everything and I also changed some of the names to be shorter but still make sense.