Code for Sprint 2

Dependencies:   C12832 mbed rtos RangeFinder