Linear Kalman Filter for Attitude Estimation from Angular Rate and a Single Vector Measurement

Figure 2

The upper monitor can effectively show the real-time attitude from SVO-LKF.