Problem implementing ultrasonic interrupt (new ping library)