Debug + Fixed a few Ports (COMPETITION CODE)

The sensors are now accurate for BOTH the COMPETITION and PRACTICE
robot, however.