Created the sonar module

Fully tested and functional

Also revealed a few small bugs in gpio and time modules
Merge pull request #10 from ut-ras/sonar

Merging Sonar Module