P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes
-
Upload
guy-emerson -
Category
Documents
-
view
19 -
download
0
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://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/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
Final Project PresentationECE 4007, L01 DK2
April 26, 2010
![Page 2: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/2.jpg)
Project Overview• Proof of Concept Prototype• Autonomous Convoy
Vehicles (ACVs)• Path-follow Algorithm• Modularity• Passive Operation• Cost: $450
• 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://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/3.jpg)
Final Design
Motor Steering Servomechanism
Photo-Reflectors
Battery Bay
![Page 4: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/4.jpg)
Final Design
![Page 5: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/5.jpg)
Final Design
Altera DE2 FPGA Development Board
![Page 6: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/6.jpg)
Final Design
Electronic Speed Control
![Page 7: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/7.jpg)
Final Design
I/O Daughter Board
![Page 8: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/8.jpg)
Final Design
Steering Servomechanism
Electronic Speed Control
Left Photo-Reflector
Right Photo-Reflector
![Page 9: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/9.jpg)
Final Design
GPIO to Altera DE2 FPGA Development Board
![Page 10: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/10.jpg)
Final Design
Nintendo Wii Sensor Bar
![Page 11: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/11.jpg)
Final Design
IR Band-pass filter
![Page 12: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/12.jpg)
Final Design
![Page 13: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/13.jpg)
I/O Daughter Board
• Interface between the FPGA and the rest of the systemo Photo-Reflector circuit including analog to discrete
conversion for odometryo Bidirectional 3.3v to 5v level shiftingo IR Camera array with 35 degrees between cameras
![Page 14: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/14.jpg)
IR Camera Array• Mounted three infrared cameras taken from Nintendo's Wii
Remoteo Slightly overlapping field of view between cameras results
in an overall system horizontal FOV of 105 degrees
![Page 15: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/15.jpg)
IR Emitter Bar• Purchased after-market Sensor Bars
o Poor angular response resulted in unreliable tracking when not straight to the camera
o Ambiguity arose since the sensor bar could be interpreted as two or four blobs
• Custom machined sensor bars with extra angled LEDso Distance between IR LEDs was not
sufficient to be reliably tracked at far distances
• Borrowed the more expensive official Nintendo branded sensor bars from peers
![Page 16: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/16.jpg)
VHDL System Block Diagram
![Page 17: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/17.jpg)
VHDL System Block Diagram
![Page 18: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/18.jpg)
VHDL System Block Diagram
![Page 19: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/19.jpg)
VHDL System Block Diagram
![Page 20: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/20.jpg)
VHDL System Block Diagram
![Page 21: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/21.jpg)
Odometry and Coordinate System• Decided to maintain an absolute non-moving coordinate
system in the odometry module.o Origin is fixed at midpoint of the rear axle of the car's
initial position
• Rollover is not a concern as millimeter precision still allows for an operating range of more than 4000 kilometers in either axis
![Page 22: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/22.jpg)
Waypointed Path-following• Waypoints to the preceding vehicle are generated by
calculating their relative displacement in the absolute coordinate system
• Compensation for the disparity between rear wheel axle and camera position uses orientation information from the odometry module
![Page 23: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/23.jpg)
Waypointed Path-following• Waypoints to the preceding vehicle are generated by
calculating their relative displacement in the absolute coordinate system
• Compensation for the disparity between rear wheel axle and camera position uses orientation information from the odometry module
![Page 24: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/24.jpg)
Waypointed Path-following• Waypoints to the preceding vehicle are generated by
calculating their relative displacement in the absolute coordinate system
• Compensation for the disparity between rear wheel axle and camera position uses orientation information from the odometry module
![Page 25: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/25.jpg)
Waypointed Path-following• Waypoints to the preceding vehicle are generated by
calculating their relative displacement in the absolute coordinate system
• Compensation for the disparity between rear wheel axle and camera position uses orientation information from the odometry module
![Page 26: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/26.jpg)
Waypoint Queue• Queue maintains:
o Waypointso Current ACV positiono Total sum of all waypoints
• Relative coordinateso Waypoints relative to previouso Current relative to last passed
• Absolute coordinateso Reads from odometryo Calculates and uses deltaso Ignores overflow
![Page 27: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/27.jpg)
Adding Future Waypoints• Given:
o Sum of waypointso Current positiono Position of LED bar
• Calculate:o Vision - QueueSum + Current
• Add to end of queue
![Page 28: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/28.jpg)
Waypoint Steering and Throttle Control• Compare current and first waypoint output from queue
o Gives distance and angleo Constantly updated
• Steers using linear approximationo Deadband in centero Configurably aggressive turns
• Throttle gets "kickstart" and returnso Overcome momentum requiremento Sustain slower speed
![Page 29: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/29.jpg)
Waypoint Queue Maintenance• Approaching next waypoint
o Linear distance approximationo Drops waypoint earlyo Avoids unstable turning angles
• Minimum waypoint sum for followingo Linear distance approximationo Disables output to ESCo Avoids collisions
![Page 30: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/30.jpg)
Acceptance Testing Overview• Path-following
o Max deviation from path Using a fixed set of waypoints, test runs show ACVs
pass over waypointso Follow distance
Images captured from test runs using known distances to verify actual following distance
o Turning radius Driving the lead vechicle around a turn and observing
the ACV following performance• Modular ACVs
o Placing multiple ACVs in a line and driving the lead vehicle while observing following behavior
![Page 31: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/31.jpg)
Path-following Characteristic
![Page 32: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/32.jpg)
In-motion Specifications
![Page 33: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/33.jpg)
The PACMAN
![Page 34: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/34.jpg)
Objectives
• Path-followingo Follow distance: <200 cmo Max deviation from path: <10 cm
• Autonomous operationo Speed: >40 cm/so Turning radius: <200 cm
• Passive operation
• Modular ACVs
![Page 35: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/35.jpg)
Objectives and Achievements
• Path-followingo Follow distance: <200 cm ~98 cmo Max deviation from path: <10 cm ~9 cm
• Autonomous operationo Speed: >40 cm/s ~60 cm/so Turning radius: <200 cm ~133 cm
• Passive operation
• Modular ACVs
![Page 36: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/36.jpg)
Objectives and Achievements
• Path-followingo Follow distance: <200 cm ~98 cmo Max deviation from path: <10 cm ~9 cm
• Autonomous operationo Speed: >40 cm/s ~60 cm/so Turning radius: <200 cm ~133 cm
• Passive operation
• Modular ACVs
Demonstrate the feasibility of an
autonomous path-following system
![Page 37: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/37.jpg)
Future Work
• Integration of system into a full-scale convoy• Improvements to hardware during full-scale conversiono More accurate and flexible
odometry, such as optical flow
o More capable vision systemo More robust processing unit,
including a floating point unit and a trigonometry unit
![Page 38: P ath-Following A utonomous C onvoy with M ultiple A synchronous N odes](https://reader030.fdocuments.net/reader030/viewer/2022032605/56812bb4550346895d8ff4fe/html5/thumbnails/38.jpg)
Questions?