Added SmartDashboard outputs for ultrasonic