Ultrasonic code now works using the ros serial interface