here the code from mini-me prtotype and the two test sonars