Added sonar in stdr_robot and CMakeLists
Added sonar header file
Fixed errors in CMakeLists and header files
Implemented sonar functionality
Merge pull request #79 from 'sonar_implementation' into develop