מסנן קלמן

מסנן קלמן הוא אלגוריתם המבוסס על מסנן בייסיאני, המקבל כקלט סדרה של מדידות מורעשות של ערכים שונים המייצגים מצב של מערכת בזמן מסוים, ומספק הערכה סטטיסטית של מצב המערכת על סמך תוצאת המסנן בעבר. המסנן נקרא על שם רודולף קלמן, אחד ממפתחיו הבולטים.

למסנן יישומים רבים בטכנולוגיה. אחד היישומים העיקריים הוא בהנחיה, ניווט ובקרה של כלי רכב, במיוחד מטוסים, טילים או רכבי חלל. הוא מיושם רבות בעיבוד אותות ואקונומטריקה.

האלגוריתם מכיל מערכת משוואות והוא עובד בשני שלבים מרכזיים: ראשית, האלגוריתם מספק הערכה של מצב המערכת (כלומר, ערכי המדדים שלה) ושל ערכי אי הוודאות שלהם. בשלב השני, נקלטות התוצאות של המדידות הבאות (בדרך כלל כולל שגיאות מדידה מסוימות). תוצאות אלו מקבלות כל אחת משקל משלה והוא מעדכן באמצעותן את מצב המערכת. משקל כל תוצאה תלוי ברמת האמינות אותה מייחס האלגוריתם לאותה מדידה. המשקלים יכולים להשתנות במשך פעולת המסנן בהתאם לתוצאות המתקבלות בכל מדידה. כך למשל, במידה שמתקבל הפרש גבוה בין ההערכה לבין המדידה, המסנן עשוי להפחית את המשקל שהוא נותן להערכות הקודמות שלו ולהגביר את המשקל הניתן לתוצאה, ולהפך.

האלגוריתם משתמש רק במדידות החדשות ובמצב המערכת כפי שהתקבל מההערכה שלו, ללא התייחסות לערכים קודמים. לפיכך, קל ליישם את האלגוריתם במערכות זמן אמת.

על מנת לקבל תוצאות מיטביות, האלגוריתם נדרש לקבל הערכות נכונות בקשר לדיוק המשתנים המתקבלים. במידה ואין הערכה כזו, תוצאות המסנן תהיינה טובות פחות, אך עדיין טובות בהרבה משימוש בשיטות רגילות, כמו ממוצע נע.

במסנן נעשה שימוש גם במצב בו מעוניינים לאחד את אותה מדידה משני חיישנים שונים ובלתי תלויים לטובת ערך מדויק יותר מכל אחת משתי המדידות.

תיאור מתמטי של מסנן קלמן עריכה

פעולת מסנן קלמן כוללת שני שלבים:

חיזוי: הפעלת מודל חיזוי כדי לקבל הערכה של מצב המערכת טרום מדידה (א-פריורי).
עדכון: עדכון ההערכה בעקבות התצפיות/מדידות שהתקבלו בפועל.

נסמן:

${\hat {\mathbf {x} }}_{k\mid k}$ – הערכת מצב המערכת במצב ה-k בהינתן המצב ב-k המצבים שלפניו
$\mathbf {P} _{k\mid k}$ – הערכת אי-ודאות מצב המערכת. השונות המשותפת במצב ה-k בהינתן המצב ב-k המצבים שלפניו
$\mathbf {F} _{k}$ (לעיתים מסומן ב-Φ) מודל החיזוי המתאר כיצד מתפתחת המערכת במעבר משלב k-1 לשלב k (לפי מודל שמניח החוקר)
$\mathbf {u} _{k}$ – קלט מבוקר שמכניסים למערכת
$\mathbf {B} _{k}$ – איבר המתאר כיצד הקלט משפיע על המערכת (לפי מודל שמניח החוקר)
$\mathbf {Q} _{k}$ – רעש תהליך. השונות המשותפת של הרעש בתהליך הקידום של מצב המערכת
$\mathbf {z} _{k}$ – המדידות והתצפיות בשלב k
$\mathbf {R} _{k}$ – רעש מדידה. השונות המשותפת של הרעש שנוצר בתהליך המדידה. שגיאות מדידה, התפלגות תצפיות וכו'.
$\mathbf {H} _{k}$ – איבר המתאר את הקשר בין המדידה למצב המערכת.
בשלב העדכון אנו נשווה בין התוצאות שחוזה המערכת לבין התוצאות שנמדדו בפועל (תצפיות) ועל-פי זה נתקן את ההערכה.

חיזוי עריכה

הערכת מצב המערכת (א-פריורי)	${\hat {\mathbf {x} }}_{k\mid k-1}=\mathbf {F} _{k}{\hat {\mathbf {x} }}_{k-1\mid k-1}+\mathbf {B} _{k}\mathbf {u} _{k}$
הערכת אי ודאות השגיאה. שונות משותפת (א-פריורית)	$\mathbf {P} _{k\mid k-1}=\mathbf {F} _{k}\mathbf {P} _{k-1\mid k-1}\mathbf {F} _{k}^{\mathrm {T} }+\mathbf {Q} _{k}$

עדכון עריכה

חישוב ההפרש בין התצפיות לתחזית	${\tilde {\mathbf {y} }}_{k}=\mathbf {z} _{k}-\mathbf {H} _{k}{\hat {\mathbf {x} }}_{k\mid k-1}$
חישוב אי הוודאות (השונות המשותפת)	$\mathbf {S} _{k}=\mathbf {R} _{k}+\mathbf {H} _{k}\mathbf {P} _{k\mid k-1}\mathbf {H} _{k}^{\mathrm {T} }$
חישוב הגבר קלמן מיטבי (optimal Kalman gain)	$\mathbf {K} _{k}=\mathbf {P} _{k\mid k-1}\mathbf {H} _{k}^{\mathrm {T} }\mathbf {S} _{k}^{-1}$
עדכון מצב המערכת (פוסטריורי)	${\hat {\mathbf {x} }}_{k\mid k}={\hat {\mathbf {x} }}_{k\mid k-1}+\mathbf {K} _{k}{\tilde {\mathbf {y} }}_{k}$
עדכון הערכת אי הוודאות (שונות משותפת) (פוסטריורי)	$\mathbf {P} _{k\|k}=(\mathbf {I} -\mathbf {K} _{k}\mathbf {H} _{k})\mathbf {P} _{k\|k-1}(\mathbf {I} -\mathbf {K} _{k}\mathbf {H} _{k})^{T}+\mathbf {K} _{k}\mathbf {R} _{k}\mathbf {K} _{k}^{T}=(\mathbf {I} -\mathbf {K} _{k}\mathbf {H} _{k})\mathbf {P} _{k\|k-1}$
ההתאמה בין המדידות להערכה המעודכנת	${\tilde {\mathbf {y} }}_{k\mid k}=\mathbf {z} _{k}-\mathbf {H} _{k}{\hat {\mathbf {x} }}_{k\mid k}$

התאמות למסנן קלמן עריכה

האלגוריתם המקורי של מסנן קלמן מתאים להנחות יסוד מסוימות, למשל מודל החיזוי צריך להיות ליניארי, הרעש מוגדר גאוסיאני ועוד התניות כפי שמפורט לעיל. לצורך פתרון של מערכות פיזיקליות שאינן עונות על הנחות היסוד פותחו "מסנני קלמן" מתקדמים.

EKF - מסנן קלמן מקורב ליניארית עריכה

מסנן זה טוב למקרים בהם מודל החיזוי אינו ליניארי, אך קירוב שלו מסדר ראשון הוא "מספיק טוב". לביצוע קירוב מסדר ראשון גוזרים את מודל החיזוי.

שימושים עריכה

ניתן להשתמש באלגוריתם למערכות הגנה אווירית כגון כיפת ברזל כאשר מתגלה איום על ידי מכ"ם, המיקום והמהירות ההתחלתיים של הרקטה או הפגז הנכנסים נמדדים. מדידות אלו רועשות מטבען בשל אופי זיהוי המכ"ם והסביבה. מסנן קלמן משמש להערכת המצב (מיקום, מהירות ואולי תאוצה) של הקליע בהתבסס על מדידות ראשוניות אלו. לאחר מכן ניתן לחזות את המהירות העתידיים של הקליע בשלבי הזמן הבאים.

שימוש נוסף הוא במערכות מיפוי רובוטי.

קישורים חיצוניים עריכה

מדיה וקבצים בנושא מסנן קלמן בוויקישיתוף

פילטר קלמן, דף שער בספרייה הלאומית
מסנן קלמן, באתר MathWorld (באנגלית)

A New Approach to Linear Filtering and Prediction Problems, by R. E. Kalman, 1960
Kalman and Bayesian Filters in Python. Open source Kalman filtering textbook.
How a Kalman filter works, in pictures. Illuminates the Kalman filter with pictures and colors