Several changes made during competition.
Issues fixed during day two of the competition.

Added a sanity count. Fixed an issue regarding the default state of the shifter solenoids.

Temporarily disabled the sending of data to the driver station display due to a show-stopper bug faced on the competition field only. For more information regarding said show-stopper, see the e-mails I've sent to our mailing list regarding the issues faced at the competition. If you wish to see the fix I have developed for this issue (untested), see http://github.com/Auv5/Wham-O.