added sonar sensor code