P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes
-
Upload
anchoret-wright -
Category
Documents
-
view
15 -
download
1
description
Transcript of P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes
![Page 1: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/1.jpg)
Path-Following Autonomous Convoy with Multiple Asynchronous Nodes
Kyle Lemons, Heather Macfie,Tri Pho, G. M. Ewout van Bekkum
PACMAN
Georgia Institute of TechnologySchool of Electrical and Computer Engineering
Preliminary Design ReviewECE 4007, L01 DK2
March 17, 2010
![Page 2: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/2.jpg)
Project Overview
• Proof-of-concept prototype• Two or more Autonomous
Convoy Vehicles (ACVs)• Path-follow algorithm• Cost: $300
• Military convoy applications• Reduction of human
requirements• Supplement to existing
navigation systems• Alternative to complex inter-
vehicle communications
![Page 3: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/3.jpg)
Design Objectives
• Path-followingo Follow distance: 100 cmo Max deviation from path: 10 cm
• Autonomous operationo Speed: 60 cm/so Turning radius: 50 cm
• Passive operation
• Modular ACVs
![Page 4: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/4.jpg)
Project Schedule
• Completed on or ahead of scheduleo Parts orderedo Wheel encoders and infrared cameras mounted, wired,
and communicating with FPGAo PWM implemented to control steering and accelerationo FPGA powered and equipped with basic track and follow
• Ultrasonic range finders may be unnecessary
• Upcoming worko Custom PCB development begins March 22 o Algorithm determination and optimization begin March 29o Sensor bar mounting begins April 2
![Page 5: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/5.jpg)
System Module Interaction
![Page 6: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/6.jpg)
Current Prototype
![Page 7: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/7.jpg)
Component Protocols and Standards
![Page 8: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/8.jpg)
Component Protocols and Standards
![Page 9: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/9.jpg)
Component Protocols and Standards
![Page 10: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/10.jpg)
Component Protocols and Standards
![Page 11: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/11.jpg)
Robot Vision
• Options for optically tracking preceding vehicle:o Vision sensor: CMUcamo Laser rangefinder: Neato Robotics’ Revo LDSo Infrared sensor: Nintendo’s Wii Remote
Images: http://www.cmucam.org; http://www.hizook.com/blog/2009/12/20/ultra-low-cost-laser-rangefinders-actualized-neato-robotics; http://www.gadgetspage.com/toys-games/how-does-the-wii-remote-work.html
CMUcam Revo LDS Wii Camera
![Page 12: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/12.jpg)
Wii Remote's PixArt Infrared Camera
• Sensitive to any bright light sourceo IR pass filter isolates IR wavelengths
• Fast embedded blob trackingo Up to four blobs at onceo Refresh rate of 100 Hz
• Communication over I²C protocolo Supports fast mode (400 kbit/s)
• Field of view of 40°o Initially troublesome
![Page 13: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/13.jpg)
Resolved Problem:Configuration of Camera and IR LEDs• Initially, the sensor bar (the IR LEDs) was to be placed horizontally
o The issue arose for discerning the difference between turning car and distant caro Stereoscopic vision for depth perception was the fix
![Page 14: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/14.jpg)
Limited Field of View• In order to meet design specifications, more than two cameras were needed• Stereoscopic vision required an overlap of camera field of views
![Page 15: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/15.jpg)
Thinking in the Wrong Direction
• Attempting to compensate for poor initial configuration
• Reorient the sensor bar verticallyo Resolves turning ambiguityo Simplifies relative location calculation
• Requires three cameras instead of seven for a 120° FOV
![Page 16: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/16.jpg)
Relative Location: Direction
![Page 17: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/17.jpg)
Relative Location: Distance
![Page 18: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/18.jpg)
PWM Control: Steering and Throttle• Pulse Width Modulation (PWM)
o Controlled by signal duty cycleo Variable duty cycleo Constant frequencyo Simple to implement in hardware
• RC platform includes PWM control of steering and throttleo Experimentally determined timingso 50 Hz frequency, limited to 5% to 10% duty cycle
![Page 19: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/19.jpg)
Steering Control• Steering PWM control signal
o Calibration required per RC unito Control module uses 1024 steps
• Servo motoro Servo motor controller has unknown PWM resolutiono Experimentally determined behaviors
Symmetrical "left" and "right" sensitivity Centered around 7.1%
![Page 20: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/20.jpg)
Throttle Control• Throttle PWM control signal
o Large "idle" dead-band for throttleo Higher "forward" sensitivity than "reverse"o Brake mode function problems
• Drive motoro Requires higher throttle to "kick-start" movement
Will prove problematic when trying to move slowlyo Higher top forward speed than reverse
![Page 21: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/21.jpg)
Odometry
• Where are we on the measured path • Estimate our location with odometry
o Optical Flow Optical mouse Web-cam
o Rotary Encoder Magnetic Photo-interrupters Photo-reflector
Image: http://www.mccoop.de/images/street-video.png
![Page 22: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/22.jpg)
• Measure rotation of rear wheels• Calculate change in heading and position• Implement in the FPGA as a module in VHDL
Dead Reckoning with Differential Drive
![Page 23: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/23.jpg)
Quadrature Wheel Encoding
• Pattern inside rear wheels • Quadrature encoding
o Gray code output o Double resolutiono Simpler acceptance testing
![Page 24: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/24.jpg)
• HLC1395-002 Photo Reflector from Honeywell o Infrared LED and photo-transistor in the same package o 100 mW power dissipationo 0.6 mA photo-transistor on current
• Inverting Schmitt Triggero Debounce and convert analog to discrete output
Electrical Design of Wheel Encoders
![Page 25: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/25.jpg)
Physical Design of Wheel Encoders
![Page 26: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/26.jpg)
Problems with Wheel Encoding
• What if the wheels slips? o Remove power to the rear wheel
• Maximum resolution?
o No optical specifications other than “unfocused”o Testing showed ~36-48 steps per revolution
• Duty cycle in the gray code exactly 50%?
o Photo-reflector measures reflectance, but what if it sees more than one step?
o Optimize duty cycle of the light areas on the pattern
![Page 27: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/27.jpg)
Path Generation
• Markers denote lead vehicle position
• "Visual Snakes"
• Optionso Regressiono Cluster averaging
• Issues for considerationo Computational complexityo Path accuracy
![Page 28: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/28.jpg)
Path Traversal• Comparing vehicle location with
path generated
• Optionso Absolute reference frameo Relative reference frameo Moving reference frame
• Issues for considerationo Numeric overflowo Pre-/Post-processingo Compounding rounding error
Absolute reference
Relative reference
Moving reference
![Page 29: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/29.jpg)
PACMAN
• Final Prototypeo More cameraso Two ACVso Path-following
• Current Prototypeo One camerao Limited field of viewo Basic point-and-steer followo Coasts to a stop
![Page 30: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader037.fdocuments.net/reader037/viewer/2022110210/56812bb7550346895d8ffa1a/html5/thumbnails/30.jpg)
QuestionsBut first! A demo...