simple robot test program for sonar sensor