Initial commit of preliminary drivers, library and test program code