Color Mode 1 + Code Clean Up

Clean up code and added some comments, working on color mode 1
(potentiometer controlled)