Implemented Extended Kalman Filter

NOT TESTED!!! Implemented the Extended Kalman filter. Also changed
some of the documentation for the KalmanFilter class.