Working code for one sonar

Scan world, and plot readings in matlab in a comprehensive fascion