Sonar sensor, now is working correctly
Merge pull request #2 from DirtyPaul/sonar_test

Sonar sensor, now is working correctly