Updated the test hardware sketch to print data on terminal and other improvements.