Initial commit of source and cmake files