Doesn't work! Delete.
Move printf() macro to a util header
Add a simple test of the ultrasonic sensor.