Changes at competition

Commented out Ultrasonic Sensor, and changed the Pneumatics port numbers
for solenoids 5-6 (now 6-7)
Clean Up All code