Cleanup unused code, add BSD 2 Clause Licence  and update makefile

-Added MSP430 commands to makefile
-Added Licence.txt and BSD headders to source files
-Clean up unused code and fix warnings