My final code

Dependencies:   N5110 PowerControl SRF02 mbed