Added Kalman filter to Pigeon library
Fixed Kalman filter in Pigeon library