Pin Fixes

Added in values for some pins
Fixed Mode State Machine