Sensor reading works Good! Prints results to COM port. Cleanup needed