san diego 7/11/01 virtual shells for avoiding collisions yale university a. s. morse
Post on 20-Dec-2015
213 views
TRANSCRIPT
![Page 1: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/1.jpg)
San Diego7/11/01
![Page 2: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/2.jpg)
VIRTUAL SHELLS FOR AVOIDING
COLLISIONS
Yale University
A. S. Morse
![Page 3: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/3.jpg)
OVERALL PROBLEM
Develop local control concepts to enable a large groupingof mobile autonomous agents to perform biologicallyinspired group maneuvers such as schooling, swarming,flocking in a safe and purposeful manner.
![Page 4: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/4.jpg)
THE MAIN ISSUE
COLLISION AVOIDANCE
Virtual Shells
![Page 5: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/5.jpg)
The concept of a virtual shell stems from two ideas:
•Neighbors can cooperate•The ``block’’ or ``moving slot’’ protocol
![Page 6: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/6.jpg)
The concept of a virtual shell stems from two ideas:
•Neighbors can cooperate•The ``block’’ or ``moving slot’’ protocol
![Page 7: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/7.jpg)
•Schooling fish sometimes rub against each other •Flocking birds sometimes gently hit each other•Individuals sometimes maneuver through a crowd by pushing•Crowds reform by gently nudging to pass through a portal•Children can successfully maneuver bumper cars at amusement parks•Football players sometimes guide teammates motion by pushing
Cocktail Party Problem
A key component of large group coordination seems to bethe ability of agents to cause nearest neighbors to cooperatively react to their wishes in order to effectively maneuver.
Behaviors which affect group coordination:
![Page 8: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/8.jpg)
•Neighbors can cooperate•The ``block’’ or ``moving slot’’ protocol
![Page 9: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/9.jpg)
•Neighbors can cooperate•The ``block’’ or ``moving slot’’ protocol
![Page 10: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/10.jpg)
RAILROAD
block 1 block 4block 3block 2
At most one train in one block at one time
BLOCK CONTROL
Generalization
![Page 11: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/11.jpg)
Personal Rapid Transit
A dedicated guideway network on which small driverless vehicles movebetween stations under computer control.
Slot Concept: Contiguous streams of computer generated virtual blocks or slots move along each segment of guideway withvariable temporal and physical spacings defined in such a way sothat the slot flow is the same throughout the network. Slots merge atmerges and diverge at diverges.
At most one vehicle can occupy one slot at one time.
![Page 12: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/12.jpg)
Personal Rapid Transit
A dedicated guideway network on which small driverless vehicles movebetween stations under computer control.
Induces anatural hierarchy:
Slot Concept: Contiguous streams of computer generated virtual blocks or slots move along each segment of guideway withvariable temporal and physical spacings defined in such a way sothat the slot flow is the same throughout the network. Slots merge atmerges and diverge at diverges.
At most one vehicle can occupy one slot at one time.
•Vehicle slot-tracking controllers•Slot assignment based on real-time network flows•Slot slipping or vehicle maneuvering control
![Page 13: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/13.jpg)
The Virtual Shell Concept
By a virtual shell is meant a closed non-deformable surface of appropriate shape
For planning purposes, shells are regarded as rigid dynamical bodieswhich move through 2d or 3d space and are subject to force fields.
Force fields are typically determined by potential functions designedto accomplish particular tasks.
A swarm or school or flock of virtual shells thus admits the model of a hybrid dynamical system.
Shells can gently hit each other, but such collisions are always “lossless”.
![Page 14: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/14.jpg)
Collision avoidance is achieved by requiring each vehicle to remain within its own shell for all time
This is accomplished by “conventional” tracking control applied to each vehicle.
For this to be possible, each vehicle must know the trajectory of the shell it is tracking.
Since shell trajectories are determined by force fields and collisions with nearest neighbors, nearest neighbor shell position and orientationmust be available to each vehicle.
Communication between nearest neighbors is thus required.
![Page 15: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/15.jpg)
Issues
•Shell shape •Impact rules•Impact detection•Tracking controllers•Virtual force fields
![Page 16: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/16.jpg)
Issues
•Shell shape •Impact rules•Impact detection•Tracking controllers•Virtual force fields
2D: circles or ellipses3D: spheres or ellipsoids
![Page 17: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/17.jpg)
Issues
•Shell shape •Impact rules•Impact detection•Tracking controllers•Virtual force fields
![Page 18: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/18.jpg)
1. Elastic collision rule: Impacting shells interchange normal components of velocity vectors at impact point.
2. Reflection rule: Impacting shells each change the sign of its normal component of its velocity vector’s at impact point.
![Page 19: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/19.jpg)
Issues
•Shell shape •Impact rules•Impact detection•Tracking controllers•Virtual force fields
Easy for circles and spheres: Impact occurs just when distance between centers equals sum of radii.
What about ellipsoids ?
![Page 20: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/20.jpg)
x0Q ix + 2cix + di = 0; i = 1;2
Detecting Intersecting EllipsoidsDetecting Impacting Ellipsoids
![Page 21: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/21.jpg)
x0Q ix + 2cix + di = 0; i = 1;2
Q1x + c01= õ(Q2x + c02)
x0Q1x + c1x = õ(x0Q2x + c2x)
c1x + d1= õ(c2x + d2)
22
22
11
11 ''det
dc
cQ
dc
cQ
Detecting Impacting Ellipsoids
![Page 22: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/22.jpg)
![Page 23: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/23.jpg)
Issues
•Shell shape •Impact rules•Impact detection•Tracking controllers•Virtual force fields
![Page 24: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/24.jpg)
Issues
•Shell shape •Impact rules•Impact detection•Tracking controllers•Virtual force fields
….for a three wheeled, nonholonomic cart
![Page 25: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/25.jpg)
L
R
x
y
Nonholonomic Cart
![Page 26: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/26.jpg)
zç1=r1zç2=r2zç3=z1r2à z2r1
z1=xcosþ+ysinþz2=þz3=2(x sinþ à ycosþ) à þ(x cosþ+ysinþ)
r1=u à v(x sinþ à ycosþ)r2=v
Brockett
nonholonomicintegrator
Do not exist continuoustime-invariant control lawsu = f(x, y, ) v = g(x, y,)which stabilizethe origin x =y = = 0 !
nonholonomic cart model
![Page 27: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/27.jpg)
nonholonomic cart model
Tracking Problem: Devise a feedback controller whichcauses the nonholonomic cart to “track” a given reference trajectory {xr, yr, r}.
Sussmann and LiuBrockett and MorgansenDeLuca et. al.
Approximate inversion
Model Following
![Page 28: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/28.jpg)
Find tracking controlsto cause x ! xr, y ! yr,
and ! r
Implement
nonholonomic cart model
nonholonomic cart reference
![Page 29: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/29.jpg)
nonholonomic cart model
nonholonomic cart reference
error system
![Page 30: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/30.jpg)
error system
![Page 31: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/31.jpg)
error system in new coordinates
![Page 32: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/32.jpg)
error system in new coordinates
![Page 33: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/33.jpg)
error system in new coordinates
closed-loop
![Page 34: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/34.jpg)
error system in new coordinates
closed-loopstable
stable
![Page 35: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/35.jpg)
error system in new coordinates
closed-loopgoing to zero
![Page 36: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/36.jpg)
![Page 37: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/37.jpg)
Suppose a vehicle is initially centered on its shell and that at most n reflection rule determined collisions can occur before the precedingtracking control can re-center the vehicle within its shell. Then themaximum distance from center cannot exceed n
This is a consequence of the already shown fact that
is non-increasing, the fact that
and the fact that can jump by at most at each impact.
What’s it take to keep a vehicle in its shell?
![Page 38: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/38.jpg)
= 35
distanceof vehicle from centerof its shell
number of impacts
![Page 39: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/39.jpg)
Each vehicle must continuously compute its own shell’s position.
Since each vehicle’s shell position depends on impacts with the shells of nearest neighbors, nearest neighbor shell position and orientationmust be available to each vehicle.
Communication between nearest neighbors is thus required.
One possible way to avoid the need for this communication, it for eachvehicle to assume that its neighbors are centered within their shellsat impact – this is the centering protocol.
Worst case vehicle spacing = shell radius
![Page 40: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/40.jpg)
![Page 41: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/41.jpg)
![Page 42: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/42.jpg)
![Page 43: San Diego 7/11/01 VIRTUAL SHELLS FOR AVOIDING COLLISIONS Yale University A. S. Morse](https://reader030.vdocuments.us/reader030/viewer/2022032704/56649d415503460f94a1b2bf/html5/thumbnails/43.jpg)