מה באמת נדרש כדי לגרום לרובוט לנוע במדויק

צלילה לעומק · דינמיקה ובקרה · ‎~15 דקות קריאה

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

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

1 · רובוט הוא מכונה לא-לינארית ומצומדת

מתחילים מהפיזיקה, כי כל השאר נגזר ממנה. לא משנה מה המבנה של הרובוט וכמה צירים יש לו — תנועה של רובוט קשיח מצייתת למשוואה אחת, משוואת התנועה של המניפולטור, שמתקבלת משיטת אוילר–לגראנז':

$$\underbrace{M(q)\,\ddot{q}}_{\text{inertia}} + \underbrace{C(q,\dot{q})\,\dot{q}}_{\text{Coriolis / centrifugal}} + \underbrace{g(q)}_{\text{gravity}} + \underbrace{\tau_f(\dot{q})}_{\text{friction}} = \tau$$

כאן q הוא וקטור הזוויות של המפרקים, q̇ ו-q̈ הם המהירויות והתאוצות שלהם, ו-τ הם המומנטים שהמנועים מפעילים. שווה לקרוא אותה איבר-איבר, כי כל איבר הוא כאב ראש הנדסי בפני עצמו:

• אינרציה, M(q)·q̈. ‏M(q) היא מטריצת המסה — ההכללה הרב-ממדית של "מסה". המילה הקריטית כאן היא q: האינרציה האפקטיבית משתנה עם התנוחה של הרובוט. זרוע פרושה קשה להאצה הרבה יותר מזרוע מקופלת. בפועל, בכל קונפיגורציה אתם מבקרים מכונה אחרת.
• כוחות קוריוליס וצנטריפוגליים, C(q,q̇)·q̇. הכוחות האלה קיימים בגלל שכמה צירים נעים בו-זמנית: סובבו מפרק אחד, והוא יפעיל כוחות צד על כל האחרים. הם גדלים עם ריבוע המהירות — ולכן בהדגמה איטית הם זניחים, ובתנועה מהירה הם הסיפור המרכזי.
• כבידה, g(q). המומנט, תלוי-התנוחה, שנדרש רק כדי להחזיק את הזרוע במקום נגד כוח המשיכה. זו הסיבה שזרוע בלי פיצוי כבידה צונחת ברגע שמרפים ממנה.
• חיכוך, τ_f(q̇). לא-לינארי, חלקו לא-רציף, והאויב השקט של מיצוב עדין. נחזור אליו בהמשך.

שתי תכונות מבניות של המשוואה הזאת הן שמאפשרות בכלל לבנות בקרה בצורה שיטתית. ראשית, מטריצת המסה תמיד סימטרית ומוגדרת-חיובית — ולכן תמיד הפיכה. שנית, בבחירה נכונה של C, המטריצה ‎Ṁ − 2C‎ אנטי-סימטרית:

$$x^{\top}\left(\dot{M}(q) - 2\,C(q,\dot{q})\right)x = 0 \quad \forall\, x$$

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

2 · למה PID לכל ציר בנפרד נתקע בקיר

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

$$\tau_i = K_p\,e_i + K_i\!\int_0^{t} e_i\,d\tau + K_d\,\dot{e}_i, \quad e_i = q_{d,i} - q_i$$

הקיר שבו זה נתקע הוא משוואה 1. ‏PID-לכל-ציר מניח שכל ציר הוא מערכת פשוטה, קבועה ומנותקת מהשאר. אבל הציר האמיתי מרגיש אינרציה שמשתנה עם התנוחה, כוחות צימוד מכל ציר אחר, ועומס כבידה קבוע. סט הגברים שמרגיש חד כשהזרוע מקופלת נהיה איטי — או לא יציב — כשהיא פרושה. הבקר שורף את כל התקציב שלו במלחמה בפיזיקה שהוא בכלל לא מכיר, ואת הגבול מגלים בדיוק כשמבקשים גם מהירות, גם עומס וגם דיוק באותו זמן. כלומר: בדיוק ביישום התובעני שבגללו קנו רובוט מלכתחילה.

לולאת PID מגיבה לשגיאה אחרי שהפיזיקה כבר יצרה אותה. בקרה מבוססת-מודל מבטלת את הפיזיקה לפני שהיא הפכה לשגיאה.

3 · בקרה מבוססת-מודל: לבטל את הפיזיקה

הרעיון פורץ הדרך — שמוכר בשם בקרת דינמיקה הפוכה (Inverse Dynamics Control), או שיטת המומנט המחושב (Computed Torque), ובתורת הבקרה: לינאריזציה במשוב — הוא להפסיק להילחם בדינמיקה ולהשתמש במודל שלה כדי לבטל אותה. אם אנחנו מכירים, ולו בקירוב, את האיברים של משוואה 1, אפשר לחשב בדיוק איזה מומנט יפיק כל תאוצה שנרצה — ולהוסיף מעל זה איבר משוב שיטפל במה שהמודל פספס.

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

$$a_q = \ddot{q}_d + K_d\,\dot{e} + K_p\,e, \quad e = q_d - q$$

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

$$\tau = \hat{M}(q)\,a_q + \hat{C}(q,\dot{q})\,\dot{q} + \hat{g}(q) + \hat{\tau}_f(\dot{q})$$

הכובעים (M̂,‏ Ĉ,‏ ĝ) חשובים: אלה האומדנים הטובים ביותר שיש למהנדס לאיברים האמיתיים. ועכשיו, ראו מה קורה אם המודל מושלם: מציבים את משוואה 5 בתוך הדינמיקה האמיתית של משוואה 1, מצמצמים איברים, ומנצלים את העובדה ש-M(q) הפיכה. כל הפלונטר הלא-לינארי והמצומד קורס למשהו מפתיע בפשטותו:

$$\ddot{e} + K_d\,\dot{e} + K_p\,e = 0$$

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

ומכיוון שמשוואה 6 מנותקת, אפשר לבחור את ההגברים ישירות מתוך התגובה הרצויה. מתייחסים לכל מפרק כמערכת מסדר שני עם תדירות עצמית ωₙ ויחס ריסון ζ:

$$K_p = \omega_n^{2}, \quad K_d = 2\,\zeta\,\omega_n$$

רוצים ציר בריסון קריטי (בלי חריגה) שמתייצב בזמן שבחרתם? קובעים ‎ζ = 1‎, בוחרים את ωₙ שנותן את זמן ההתייצבות הזה — וקוראים את ההגברים ישר מהנוסחה. זה ההבדל בין לכוון רובוט בניחושים מושכלים לבין להנדס אותו לפי מפרט.

4 · למה היציבות מוּכחת — ולא רק "נראית בסדר"

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

$$V = \tfrac{1}{2}\,\dot{e}^{\top} M(q)\,\dot{e} + \tfrac{1}{2}\,e^{\top} K_p\,e \ \ge\ 0$$

ה-V הזה הוא סך "אנרגיית השגיאה": האיבר הראשון דמוי-קינטי, השני דמוי-קפיץ. גוזרים אותה לאורך התנועה בחוג הסגור — והאנטי-סימטריה של ‎Ṁ − 2C‎ גורמת לכל איברי הצימוד המסובכים להתבטל בדיוק. נשאר רק:

$$\dot{V} = -\,\dot{e}^{\top} K_d\,\dot{e} \ \le\ 0$$

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

5 · איפה העולם האמיתי מחזיר מכה

כל מה שכתבנו עד כאן הניח מודל מושלם. לאף רובוט אמיתי אין כזה. הגרסה הכנה של משוואה 6 משאירה אגף ימני — איבר אחד שמרכז בתוכו את כל מה שהמודל פספס:

$$\ddot{e} + K_d\,\dot{e} + K_p\,e = \underbrace{M^{-1}\left[(M-\hat{M})\ddot{q} + (C-\hat{C})\dot{q} + (g-\hat{g}) + (\tau_f-\hat{\tau}_f) - \tau_d\right]}_{\delta(t)\ =\ \text{model error} \,+\, \text{disturbance}}$$

צד שמאל הוא התכנון הנקי. צד ימין, ‎δ(t)‎, הוא המציאות. כל מה שמפריד בין סימולציה למוצר שעובד אצל הלקוח חי בתוך האיבר הזה — והטיפול בו הוא רוב עבודת ההנדסה האמיתית.

שגיאת מודל וזיהוי פרמטרים

האיברים ‎(M − M̂)‎, ‎(g − ĝ)‎ וחבריהם מתאפסים רק אם המודל מדויק. גזירה וכיול של הפרמטרים הדינמיים של רובוט — מסות החוליות, האינרציות, מרכזי הכובד, מקדמי החיכוך — הם פרויקט רציני בפני עצמו. ככל שהמודל המזוהה קרוב יותר למציאות, ‎δ(t)‎ קטן יותר והביטול נקי יותר. זיהוי מערכת טוב הוא לא פורמליות: הוא קונה דיוק, ישירות.

חיכוך: הגורם המשבש הלא-לינארי

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

$$\tau_f(\dot{q}) = f_c\,\operatorname{sgn}(\dot{q}) + f_v\,\dot{q} + (f_s - f_c)\,e^{-(\dot{q}/v_s)^2}\operatorname{sgn}(\dot{q})$$

רעש חיישנים וקוונטיזציה

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

רוויה של המנוע

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

דגימה, השהיה והשעון הרב-צירי

כל זה רץ על בקר דיגיטלי, שדוגם ומחשב בצעדים בדידים — אלפי פעמים בשנייה, אבל לא ברציפות. רוחב הפס של הבקרה חסום עקרונית על ידי קצב הלולאה וההשהיה שלה — אי אפשר לדחות הפרעה מהר יותר משאפשר לחוש בה ולהגיב. במכונה רב-צירית הבעיה מוכפלת: עשרות צירים צריכים לדגום, לחשב ולהפעיל בצעד אחיד, עם תחושת "עכשיו" משותפת ונטולת ריצוד — אחרת התנועה המתואמת נמרחת. בדיוק בשביל זה קיים פילדבוס דטרמיניסטי כמו EtherCAT עם שעונים מבוזרים. זה לא פינוק תקשורתי; זו דרישת חובה לדיוק מסונכרן על פני צירים רבים.

הדפוס שכדאי לקחת הביתה

בקרה מבוססת-מודל לא מעלימה את ‎δ(t)‎ — היא הופכת אותה לקטנה ולצפויה, כך שלולאה חיצונית חסונה תוכל לנקות את השאריות. לכן מערכות רציניות לא עוצרות ב-PD מעל הלולאה הפנימית: הן עוברות ל-PID, ולפעמים לתכנונים מסוג ‎H∞‎, אדפטיביים או מבוססי-פסיביות — במיוחד כדי לדחות את אי-הוודאות שאף מודל לא לוכד עד הסוף. דיוק הוא מכפלה של מודל טוב ושל בקר שתוכנן לשרוד את חוסר השלמות של המודל.

6 · כשהרובוט נוגע במשהו

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

$$M_d\,\ddot{\tilde{x}} + B_d\,\dot{\tilde{x}} + K_d\,\tilde{x} = F_{\text{ext}}, \quad \tilde{x} = x - x_{\text{ref}}$$

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

7 · מה זה אומר על מוצר אמיתי

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

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

זאת ההנדסה ששגב טכנולוגיות עושה

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

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

---

הביסוס הטכני נשען על H. D. Taghirad,‏ Fundamentals of Robotics: Applied Case Studies with MATLAB & Python (הפרקים על דינמיקה ועל בקרת תנועה לינארית ולא-לינארית), עם מושגי הכוח והאימפדנס מאותו מקור. הסימון פושט לטובת קהל טכני רחב.