The derivation of Kalman filter equations is beyond the scope of this
paper, the interested reader can consult many excellent text books in
estimation theory [lo]. Instead, the required form of the system and
measurement equations as well as the recursive equations are briefly
presented in this section.