530 likes | 796 Views
שלמה. מדריך לבניית רובוט כדורי ב- 10,000 צעדים פשוטים. מנחה: קובי כוחיי. אנדרי גלמן. גיא עובדיה. תוכן עניינים:. 1. נושא הפרוייקט ומטרותיו. 2. התפתחות הרעיון. 3. ארכיטקטורה ודיאגרמת בלוקים. 4. תצוגת תכלית. 5. תכנון מערכת הבקרה. 6. אתגרים בפיתוח הרובוט. 7. כיווני פיתוח אפשריים.
E N D
שלמה מדריך לבניית רובוט כדורי ב- 10,000 צעדים פשוטים מנחה: קובי כוחיי אנדרי גלמן גיא עובדיה
תוכן עניינים: 1. נושא הפרוייקט ומטרותיו 2. התפתחות הרעיון 3. ארכיטקטורה ודיאגרמת בלוקים 4. תצוגת תכלית 5. תכנון מערכת הבקרה 6. אתגרים בפיתוח הרובוט 7. כיווני פיתוח אפשריים 8. סיכום ומסקנות
נושא הפרוייקט: שיטת תנועה יחודית לרובוט – רובוט "קיפוד" כדורי
שיטת ההנעה המוצעת: רובוט "קיפוד" כדורי שמתגלגל
שיטת ההנעה המוצעת: רובוט "קיפוד" כדורי שמתגלגל
מטרת הפרוייקט: חקר אופן תנועה ייחודי באמצעות בניית רובוט המממש את צורת ההנעה המוצעת: -תנועה בשטחים מפורצים -עליה וירידה במדרון -תנועה מבוקרת (ללא החלקה) -תנועה קוואזי-סטאטית • תכנון מכני ומימוש הרובוט • תכנון מערכת הבקרה לשליטה על הרובוט • מימוש האלקטרוניקה והתוכנה ליישום מערכת הבקרה • בחינת התוצאות וביצועי הרובוט
התפתחות הרעיון ... מודל דו-מימדי
התפתחות הרעיון ... מודל דו-מימדי
התפתחות הרעיון ... מודל דו-מימדי
התפתחות הרעיון ... מודל דו-מימדי
התפתחות הרעיון ... מודל דו-מימדי
התפתחות הרעיון ... מודל דו-מימדי
התפתחות הרעיון ... הקטנת מספר הרגליים ואלגוריתם צעידה בסיסי מיחזור רגליים
התפתחות הרעיון ... הקטנת מספר הרגליים ואלגוריתם צעידה בסיסי
התפתחות הרעיון ... הקטנת מספר הרגליים ואלגוריתם צעידה בסיסי
התפתחות הרעיון ... הקטנת מספר הרגליים ואלגוריתם צעידה בסיסי
התפתחות הרעיון ... הקטנת מספר הרגליים ואלגוריתם צעידה בסיסי
התפתחות הרעיון ... הקטנת מספר הרגליים ואלגוריתם צעידה בסיסי
התפתחות הרעיון ... הקטנת מספר הרגליים ואלגוריתם צעידה בסיסי
בחירת דרגות חופש מניעת החלקה המטרה: הקשר בין אורך הרגל הדוחפת לבין זוית פריסת הרגליים נקבע עפ"י משפט הקוסינוס:
הגדרת בעית הבקרה פריסת הרגל הדוחפת L(t) ושינוי הזוית α(t) צריכות להתבצע בצורה מתואמת ע"מ לקיים את משפט הקוסינוס בכל רגע ורגע הקשר בין אורך הרגל הדוחפת לבין זוית פריסת הרגליים נקבע עפ"י משפט הקוסינוס:
ארכיטקטורה מכונה המונעת ע"י 5 מנועי DC ומערכת חיישנים
ארכיטקטורה המכונה 5 בקרי PIC(slave PIC) לבקרת כל אחד מהמנועים
ארכיטקטורה slave PIC x5 המכונה בקר PIC נוסף (master PIC) המתאם ומתזמן את 5 בקרי slave PIC
ארכיטקטורה master PIC slave PIC x5 המכונה מחשב PC המבצעתכנית script אינטראקטיבית אשר מתקשרת עם master PIC באמצעות פקודות ברמה גבוהה
ארכיטקטורה PC master PIC slave PIC x5 המכונה
דיאגרמת בלוקים M DC Motor Foot pressure sensor PC Legend: USB Required position Required velocity PID Parameters Control system Configuration [↑] Upstream data Debug information Status bits [↓] Downstream data Serial master PIC PIC18F4620 Position Velocity Foot pressure Status bits SPI BUS PID Parameters Required Velocity slave PIC PIC18F2431 other slave PICs Analog Voltage PWM Motor Driver Analogpre-processing PWM Encoder pulses
חיישני סביבה • encoder על ציר מנועי DC • למדידת מיקום זויתי או אורכי של המנוע חיישני לחץ בקצות רגלי הרובוט לזיהוי נגיעה בקרקע או מכשול אחר הכנה לחיישן תאוצה כאופציה לזיהוי הזוית בין הרובוט לציר האנכי של כדה"א
: תרשים מופשט מערכת הבקרה המשולבת
: תרשים מופשט מערכת הבקרה המשולבת
motor 1 velocity : מערכת הבקרה המשולבת
motor 1 position : מערכת הבקרה המשולבת
motor 5 required position : מערכת הבקרה המשולבת
motor 5 required velocity : מערכת הבקרה המשולבת
motor 5 PWM signal : מערכת הבקרה המשולבת
motor 5 velocity : מערכת הבקרה המשולבת
motor 5 position : מערכת הבקרה המשולבת
אתגרים בבניית הרובוט: 1. תכן מכני של הרובוט 2. תכן כרטיס למעגלים החשמליים 3. מימוש אלגוריתם בקרת מהירות למהירויות נמוכות מאוד 4. פיתוח פרוטוקול תקשורת בין בקרי PIC 5. פיתוח פרוטוקול תקשורת בין מחשב PC ל- master PIC 6. מימוש תכנת PC אינטראקטיבית 7. בניית סביבת debugging
3. אלגוריתם בקרת מהירות למהירויות נמוכות מאוד רעש מברשות
3. אלגוריתם בקרת מהירות למהירויות נמוכות מאוד בעיית דיווח Encoder Pulses Clock Reported Velocity Required Velocity
אתגרים בבניית הרובוט: 1. תכן מכני של הרובוט 2. תכן כרטיס למעגלים החשמליים 3. מימוש אלגוריתם בקרת מהירות למהירויות נמוכות מאוד 4. פיתוח פרוטוקול תקשורת בין בקרי PIC 5. פיתוח פרוטוקול תקשורת בין מחשב PC ל- master PIC 6. מימוש תכנת PC אינטראקטיבית 7. בניית סביבת debugging
6. מימוש תכנת PC אינטראקטיבית % step backward, right leg pushing %%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%% #step_bw_right beep pause tracking s 4 follows s 3 a1 -1 a2 $A2_RATIO stop s 3 when s 1 touchdown set_pos s 3 $MAX_PUSH_LENGTH pos_control s 4 on pos_control s 3 on #step_bw_right__wait sleep 500 status cond $s3_waiting_for_stop_cond = 1 cond_sec step_bw_right__wait pos_control s 4 off pos_control s 3 off sleep 100 set_vel s 4 v 0 set_vel s 3 v 0 tracking s 4 off print step finished
כווני פיתוח אפשריים אלגוריתמי צעידה מתקדמים
כווני פיתוח אפשריים אלגוריתמי צעידה מתקדמים אלגוריתם צעידה רציף - ללא נפילה
כווני פיתוח אפשריים אלגוריתמי צעידה מתקדמים אלגוריתם צעידה המאפשר פניה ימינה או שמאלה