490 likes | 613 Views
ניווט ג'יפ רובוטי מבוסס GPS מצפן וחיישני מכשולים Jeepy – S חלק א' - חומרה. מנחה:קובי כוחי מציגים: נעם נבון אלדד יחיה. מבנה המצגת. סקירת הבעיה החומרה הרובוט ה GPS המצפן ומד זווית הגלגלים חישני קירבה אוטרסוניים דריברים ומנועים הבקר סביבת העבודה דוגמת בקרה בעזרת Labview.
E N D
ניווט ג'יפ רובוטי מבוססGPS מצפן וחיישני מכשוליםJeepy – Sחלק א' - חומרה • מנחה:קובי כוחי • מציגים: נעם נבון אלדד יחיה
מבנה המצגת • סקירת הבעיה • החומרה • הרובוט • ה GPS • המצפן ומד זווית הגלגלים • חישני קירבה אוטרסוניים • דריברים ומנועים • הבקר • סביבת העבודה • דוגמת בקרה בעזרת Labview
סקירת הבעיה • ניווט עצמאי של הג'יפ לפי תכנית נסיעה שהוזנה תוך כדי התחמקות ממכשולים • מפרט הדרישות: • מעבר ב-4 נקודות ציון ברחבי הטכניון. • דיוק של עד 6 מטרים מהנקודה (דיוק GPS אזרחי). • שיטת העבודה שתידרש בסיום הפרויקט. • הזנת מסלול נ"צ לתוך הבקר ובחינת מיקומו לאורך מספר נקודות במסלול. • שימוש בתצ"א או בנקודות ידועות שדיוקן גבוה (גיאודזיה) על מנת לבדוק את שגיאת המסלול של הג'יפ.
החומרה • הרובוט • ה GPS • המצפן ומד זווית הגלגלים • חישני קירבה אוטרסוניים • דריברים ומנועים • הבקר • מאפיינים ויכולות
סכימת בלוקים מצפן מנוע בקר I2C דרייבר מד זווית גלגלים וחישנים* Analog IO PWM PWM, Dig IO מייצב מצבר VGA Cable דרייבר מנוע מצבר מצבר PWM מנוע GPS
הרובוט • Peg Perego - Gaucho Grande • הנעה - 2 מנועי Brushed DC • היגוי – מנוע Brushed DC
GPS • הצגת הטכנולוגיה ויכולותיה • סיבות לחוסר דיוק • WAAS\EGNOS & DGPS • חומרה – - LVSGarmin 16x • ממשק NMEA • LVS
המצפן ומד זווית הגלגלים • מצפן CMPS03 Devantech • אות המצפן מתקבל בפרוטוקול I2C • בעיית הרעידה של המצפן • מד זווית הגלגלים
חישני קירבה אוטרסוניים • SRF04 - Ultra-Sonic Ranger • אופן התקשורת • מגבלות ואופן המיקום
דריברים ומנועים • היגוי – NI9505 • ממשק – C series של NI. • הנעה – 2 מנועי DC. • 2 H-Bridge נפרדים • הפרדת אדמות אופטית. • הספק גבוה - 14 Amper • ממשק – PWM ודיגיטלי.
הבקר • National Instruments -Single Board Rio 9642 • מאפייני הבקר • ממשקים
סביבת העבודה – LabView • Labview Robotics 2009 • סביבה גרפית • כלי אינטגרציה (FPGA -VHDL, RT - C\Java) • מודולים מובנים ואינטגרציה בחומרה. • תכנותconcurrent פשוט. • יצירת GUI בצורה קלה • "Under the hood"
Front panel – Labview • Simple GUI
Under the hood • Complex implementation
Under the hood • A closer look
חוג כיוון – בקרה כפולה Wheel (plant) Bearing Target waypoint Angle PID מצפן GPS פוטנציומטר
דוגמת בקרה בעזרת Labview • PID Controller
ניווט ג'יפ רובוטי מבוססGPS מצפן וחיישני מכשוליםJeepy – Sמצגת סוף • מנחה:קובי כוחי • מציגים: נעם נבון אלדד יחיה
מבנה המצגת • סקירת הבעיה • חוגי הבקרה • חוג כיוון • חוג מיקום • אלגוריתמים • ניווט • התחמקות ממכשולים • תוצאות • וידאו • גרפים • סיכום ומסקנות • רעיונות להמשך • תודות ושאלות
סקירת הבעיה • ניווט עצמאי של הג'יפ לפי תכנית נסיעה שהוזנה תוך כדי התחמקות ממכשולים • מפרט הדרישות: • מעבר ב-4 נקודות ציון ברחבי הטכניון. • דיוק של עד 6 מטרים מהנקודה (דיוק GPS אזרחי). • שיטת העבודה שתידרש בסיום הפרויקט. • הזנת מסלול נ"צ לתוך הבקר ובחינת מיקומו לאורך מספר נקודות במסלול. • שימוש בתצ"א או בנקודות ידועות שדיוקן גבוה (גיאודזיה) על מנת לבדוק את שגיאת המסלול של הג'יפ.
סכימת בלוקים מצפן מנוע בקר I2C דרייבר מד זווית גלגלים וחישנים* Analog IO PWM PWM, Dig IO מייצב מצבר VGA Cable דרייבר מנוע מצבר מצבר PWM מנוע GPS
Bearing loop error Target waypoint Target Bearing Bearing angle Position Steering Motor Jeep position PID Angle sensor GPS and compass חוגי הבקרה • חוג כיוון • חוג מיקום
התחלה קבל נתוני מיקום וכיוון חשב מרחק וכיוון ליעד קרוב ליעד? הגעת ליעד ? לא כן סע במהירות נמוכה (מהירות יחסית למרחק) סע המהירות גבוהה (60%) לא כן החלף waypoint סוף מסלול ? אלגוריתם ניווט לא כן
אלגוריתם ניווט FPGA GUI – System Integrator
אלגוריתם ניווט FPGA GUI
אלגוריתם ניווט FPGA GUI
אלגוריתם ניווט Motor FPGA Block diagram
TOP VI – Steering Loop Block Diagram
TOP VI – Steering Loop Block Diagram
תוצאות - חמיקה • וידאו חמיקה
תוצאות - ניווט • וידאו מסלול
סיכום ומסקנות • הרובוט: • בעיית ההיגוי • שריפת הדרייברים • חוג מהירות
סיכום ומסקנות • סביבת העבודה והבקר: • סביבת העבודה מעולה לעבודה ברובוטיקה. • ממשקים נוחים מול החומרה חיצונית ופנימית. • יכולות ה Debug טובות.
סיכום ומסקנות • החיישנים: • הGPS מציג יכולות מרשימות ודיוק גבוה מאוד. • המצפן מהווה נקודת חולשה בגלל הרעידות.
רעיונות להמשך • מכיוון שהפלטפורה אותה בנינו מאפשרת ממשק נוח, אפשר להוסיף לרובוט פונקציות רבות ומגוונות: • הוספת חוג מהירות – כיום שליטה במהירות היא ע"י חוג פתוח. • הוספת מדידים אינרציאלים ויכולת לנווט את הרובוט בתוך מבנים, או אזורים בעלי אות GPS גרוע. • הוספת יכולת ליצור מסלול ע"י אלגוריתם התווית נתיב שיאפשרו הזנת כתובת יעד בלבד, והמסלול יקבע עצמאית. • הסבה של הרובוט ל"כלב נחייה" ע"י הקניית כל היכולות הנדרשות ממנו כמו מעבר חציה וסכנות אחרות ע"י הוספת מצלמה למשל ותגובה לפקודות קוליות. • רובוט מדריך שילווה מבקרים הבאים לראות את הטכניון.