Update sonar.c

Test pour que le rugbat fasse un tour et test pour savoir la distance.
Merge pull request #7 from Guilhem117/patch-5

Update sonar.c