Added Sonar
Added Sonar and fixed junk UltrasonicSensor class