Updated Firmware for Filter Wheel

Added comments and clean code.
Merge pull request #1 from UIC-IGC/otherbranch

Updated Firmware for Filter Wheel