Added light code. Note this is not the one that uses cRIO outputs but rather my test one that is currently running 4/4/14.