Renamed variables and cleaned up code

Renamed variables, cleaned up code a bit.

Changed the digital input mapping to match cRIO code - in particular, low-low (when the robot is disabled) is now set to swag patterns.