My final code

Dependencies:   N5110 PowerControl SRF02 mbed

Revision graph

The revision graph only works with JavaScript-enabled browsers.