Add sensor code

Sensor code for the Sharp sensor and the HC_SR04