added sonar sensor
Merge origin/master