Trajectory Kalman Filter with Enhanced State Estimation

This program implements a comprehensive Kalman filter simulation for trajectory estimation, featuring velocity and acceleration measurements in the observation vector with a three-dimensional information matrix. The complete and validated implementation demonstrates practical state estimation techniques suitable for colleagues learning Kalman filter applications.