Working servo/ultrasonic sensor demo