Added sonar sensor code with value display