Use timer to trigger the ultra sensor & PID
delete filter & use median for ultrasound

delete filter & use median for ultrasound sensor
Add a processing GUI and delete the un-use version