Removed Controls

Added a Constants class to keep track of ports
Adjusted other classes to this
Should Drive now
TODO: create state machine for the shooting mech