Workable Shift Lights Code

There is a small bug where it goes into error state randomly. Gonna
debug that next and get ride of it.
Merge branch 'master' of https://github.com/mass/illini-motorsports