Create sonar.cpp

Found c++ code that might be useful for HC-SR04 sensor to read