Slight reorg; wait 2 secs after init call to ensure that the hardware really is up and running.
Added small test program.