Framework for color map done
Merge conflict
Before demo, board broken...
adding arduino code