Kalman filter and PIDController sources added