Initial commit of PIC code

*UNTESTED* for now as we don't have the hardware yet