1-Ultrasonic sensor implementation was updated (LPF and burst control algorithm were added).
2-Altitude PID Coefficients was updated.
3-Altitude Kalman implementation was updated. It also uses ultrasonic sensor data below some threshold.
4-Position PID Bug is fixed.
1-Ultrasonic sensor implementation was updated (LPF and burst control algorithm were added). 2-Altitude PID Coefficients was updated. 3-Altitude Kalman implementation was updated. It also uses ultrasonic sensor data below some threshold. 4-Position PID Bug is fixed.