Rewrote code to work with robot

add while(1) loop to the end of main so program does not exit
remove LightShow() because PWM's don't like being initialized in separate functions

It took a lot of copy/pasting for me to realize the above two things, so this might look messy. Not much has changed though.

TODO: make lights continue flashing after other functions are called