Download 5 MB PDF - BYU MERS Laboratory
Transcript
p (rad/s) Truth 2 0 SR−UKF Solution −2 50 100 150 200 250 300 350 400 450 500 50 100 150 200 250 300 350 400 450 500 50 100 150 200 250 300 Time (s) 350 400 450 500 2 0 −2 Error 0.01 0 −0.01 q (rad/s) 2 Truth 0 −2 SR−UKF Solution −4 50 100 150 200 250 300 350 400 450 500 50 100 150 200 250 300 350 400 450 500 50 100 150 200 250 300 Time (s) 350 400 450 500 2 0 −2 −4 Error 0.05 0 −0.05 r (rad/s) Truth 0.5 0 SR−UKF Solution −0.5 50 100 150 200 250 300 350 400 450 500 50 100 150 200 250 300 350 400 450 500 50 100 150 200 250 300 Time (s) 350 400 450 500 0.5 0 −0.5 Error 0.01 0 −0.01 Figure 5.8: Truth data and the SR-UKF solutions for angular rates p, q, and r. See text and Table 5.5 for analysis. 74