improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › downloads...
TRANSCRIPT
![Page 1: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/1.jpg)
Improving autonomous orchard vehicle trajectory tracking performance via slippage compensation
Dr. Gokhan BAYAR
Mechanical Engineering Department of Bulent Ecevit University
Zonguldak, Turkey
This study was conducted under the Supervision of Dr. Marcel Bergerman in the Field Robotics Center of Robotics Institute of Carnegie Mellon University,
Pittsburgh, PA, USA.
![Page 2: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/2.jpg)
Development of a slippage estimation procedure and performing a desired trajectory tracking control.
Objective of the Research
1
![Page 3: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/3.jpg)
a single set of controller parameters or a unique equation of motion
to guarantee a desired performance and accuracy
Due to changing the characteristics Of wheel-ground interaction
2
![Page 4: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/4.jpg)
the simple assumptions which are generally used in the mobile robot / autonomous vehicle applications:• ideal transmission• ideal rolling• no slippage• no lost of traction control• no external wheel forces• no surface change behavior• no disturbance, etc.
3
![Page 5: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/5.jpg)
Surface Information
<Mobile Robot> Unmanned
Ground Vehicle
Desired task
[f(x,y,t)]
[f(x,y)]
Vehicle Model
Controller
Forward Velocity
Steering Angle
x,y,θ,V,δ
Wheel-Ground Interaction
4
![Page 6: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/6.jpg)
Trajectory Tracking Control of an Autonomous Vehicle
f(X,Y,t)desired
f(X,Y,t)actual
Vehicledesired(t)
XError(t)= |XDesired(t) - XActual(t)|
YError(t)= |YDesired(t) - YActual(t)|
θError(t)= |θDesired(t) - θActual(t)|
X
Y
Vehicleactual(t)
5
![Page 7: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/7.jpg)
Dynamic approachesKinematic/Car‐like robot approachPoint mass modelDubins curves
Desired Trajectory Generator
6
![Page 8: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/8.jpg)
Car‐like robot model
7
![Page 9: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/9.jpg)
8
![Page 10: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/10.jpg)
Desired trajectory tracking controller
ΣXdesired
XPS
Σ
YPS
Ydesired
Controller
Σ
θPS
θdesired
Vehicle
Vc
Xe
Ye
θe
+
+
+
-
-
-
V
V
x, y
Φc
Φ
Φ
9
![Page 11: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/11.jpg)
Lyapunov Functions
10
![Page 12: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/12.jpg)
trees
Working Environment of an Orchard Robot Vehicle
w1
w2
11
![Page 13: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/13.jpg)
-40 -20 0 20 40 60 80 100 120-20
0
20
40
60
80
100
120
Reference Trajectory
12
![Page 14: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/14.jpg)
Turning Geometry
13
![Page 15: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/15.jpg)
14
![Page 16: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/16.jpg)
Experimental Orchard
15
![Page 17: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/17.jpg)
1. Experiments to test the behaviour of the proposed model
Slippage information is not taken into consideration.
RTK-GPS is used for position feedback.
16
![Page 18: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/18.jpg)
4 km autonomous drive achieved in the orchard
17
![Page 19: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/19.jpg)
Desired and actual steering angles for 4 km autonomous drive
18
![Page 20: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/20.jpg)
Video
19
![Page 21: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/21.jpg)
2. Experiments to test the behaviour of the proposed model.
Slippage information is not taken into consideration.
Row Detection System (via Laser Scanning RangeFinder) is used.
20
![Page 22: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/22.jpg)
21
![Page 23: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/23.jpg)
22
![Page 24: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/24.jpg)
23
![Page 25: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/25.jpg)
24
![Page 26: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/26.jpg)
25
![Page 27: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/27.jpg)
Experimental results obtained in the first row of the orchard
26
Experimental results obtained in the first row. Width = 4.44 m, Length = 52.95 m.
(a) Steering angles, (b) Lateral errors
![Page 28: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/28.jpg)
Video ‐ First Row
Width = 4.44 m, Length = 52.95 m
0.5 m/s Forward Velocity
Forward Camera Front Camera
27
![Page 29: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/29.jpg)
3. Experiments to test the behaviour of the proposed model.
Slippage information is taken into consideration.
RTK-GPS is used for position feedback.
28
![Page 30: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/30.jpg)
RTK-GPSOdometer Steering System
29
![Page 31: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/31.jpg)
30
![Page 32: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/32.jpg)
Car Like Robot Model Without Slippage
Car Like Robot Model With Slippage
It is assumed that 31
![Page 33: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/33.jpg)
Slippage Experiments on Snow
32
![Page 34: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/34.jpg)
0 5 10 15 20-10
-8
-6
-4
-2
0
2
4
6
X-Direction [m]
Y-D
irect
ion
[m]
DesiredReal
0 5 10 15 20-10
-8
-6
-4
-2
0
2
4
6
X-Direction [m]
Y-D
irect
ion
[m]
DesiredReal
Reference Trajectory Tracking Control on Snow
Vehicle Control
Without Slip Estimation
Vehicle Control
With Slip Estimation
33
![Page 35: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/35.jpg)
0 20 40 60 800
0.2
0.4
0.6
0.8
1
1.2
1.4
Time [s]
Forw
ard
Spee
d [m
/s]
w/o Estimationw/ Estimation
0 20 40 60 80-50
-40
-30
-20
-10
0
10
20
30
Time [s]
Stee
ring
Ang
le [d
eg]
w/o Estimationw/ Estimation
34
![Page 36: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/36.jpg)
4. Orchard Experiments.
Slippage information is taken into consideration.
Row Detection System (via Laser Scanning RangeFinder) is used.
35
![Page 37: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/37.jpg)
36
![Page 38: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/38.jpg)
37
![Page 39: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/39.jpg)
E1 results obtained by using RTK GPS feedback without using slippage estimation. E2 results obtained by using the slippage estimation procedure that uses RTK GPS feedback. E3 results obtained by using feedback information coming from dead reckoning algorithm. No slippage estimation procedure is adapted into the system model.E4 results obtained by using the slippage estimation process that uses the dead reckoning feedback information. 38
![Page 40: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/40.jpg)
Video ‐ Turning control without slippage estimation
39
![Page 41: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/41.jpg)
Video ‐ Turning control withslippage estimation
40
![Page 42: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/42.jpg)
1Field Robotics Center, Robotics Institute, Carnegie Mellon University, Pittsburgh, PA, USA2Mechanical Engineering Department, Middle East Technical University, Ankara, Turkey
Special thanks to the co-authors of the paper:
Gokhan Bayar*, Marcel Bergerman1, E. ilhan Konukseven2, A. Bugra Koku2, “Improving the trajectory tracking performance of autonomous orchard vehicles using wheel slip compensation”, Biosystems Engineering, vol. 146, pp. 149-164, 2016.
![Page 43: Improving autonomous orchard vehicle trajectory tracking ...ieeeagra.com › ieeeagra › Downloads › 20160721-Bayar-Presentation.pdfDr. Gokhan BAYAR Mechanical Engineering Department](https://reader033.vdocument.in/reader033/viewer/2022060504/5f1d77bf1b020146316448af/html5/thumbnails/43.jpg)
Thanks for your attention