Professional Documents
Culture Documents
مکان یابی روبات متحرک با استفاده از دوربین سه بعدی
مکان یابی روبات متحرک با استفاده از دوربین سه بعدی
sc
((
))
.
:
) ................................
) ................................
/
.
(
)
.
(
) .
.
.
.
.
.
.
.
.
.
.
.
.
.
.
:
.1
)1 - 1
2....................................................................................................................
)2 - 1
3................................................................................................................
)3 - 1
4.................................................................................................
)4 - 1
4....................................................................................................
)1-4-1
4 .............................................................................................................................................
)2-4-1
5 ................................................................................................................................
)3-4-1
6 .........................................................................................................................................
.2 8..................................................................................................
)1 - 2
9....................................................................................................................
)2 - 2
11 ...............................................................................
)1-2-2
)3 - 2
11 ....................................................................................................
19 ..............................................................................
)1-3-2
19 ...............................................................................................
)2-3-2
22 ..................................................................................................................
)4 - 2
)1-4-2
)5 - 2
)1-5-2
26 .......................................................................................
26 .......................................................................................................................................
28 .....................................................................................................
28 ................................................................................................................
.3 31.................................................................................
)1 - 3
32 ..................................................................................................................
)2 - 3
33 .......................................................................................
)3 - 3
34 ...............................................................................................
.4 45....................................................................................
)1 - 4
46 ..................................................................................................................
)2 - 4
44 ................................................................... KLD
)3 - 4
Kinect 53 ..................................................................
)4 - 4
53 .....................................................................
)5 - 4
.5 66
)1 - 5
61 ..................................................................................................................
)2 - 5
61 ........................................................................................................ ROS
)3 - 5
62 ................................................................................................ Gazebo
)4 - 5
63 .......................................................................................................... PR2
)5 - 5
64 ...................................................................................................................
)6 - 5
42 ...........................................................................................................
)4 - 5
43 ..........................................................................................................
.6
44
.4
43
- [............................................................................................... ]
- [1.......................................................................................... ]9
1- [............................................................................. ]
4- [1................................................................................... ]
- ...........................................................................
- [...................................................................................................... ]
1- [1.................. ]1
- 4.............................
9- [..................................................................................................... ]
- [9............................................................................................... ]
- [1................................. ]
- 1 1...............................................................................................
- 1 19...............................................................................................
1- 1 19..........................................................................................
4- 1 4....................................................................................
- 1 4....................................................................
- 1 4..............................................................................
- 1 4..................................................................................................
9- 1 4........................................................................................................
- 4 ......................................................................................................
- 4 ) (a (b) . ]4[ .
4...............................................................................................................................................
1- 4 [ ]4 ................................................. Kinect
4- 4 [1.......................................................... .]41
- 4 Kinect [................................................................................. ]41
- 4 ..................................................................... ]41[ Kinect
- 1.................................................................................................................... PR2
- .........................................................................................................................
1- ...........................................................................................
4- .....................................................................................
- 9...........................................................................................
- 1......................................................................................
1........................................................................................................
1........................................................................................................
1 1....................................................................................................... 1
4 1........................................................................................................ 4
.1
)1 -1
.
.
.
.
.
:
.
.
3 .
4
.
.
Fixed Frame
On-Board
Dead Reckoning
Laser Scanner
Global
)2 -1
.
.
. 7 8
9 .
.
10 11 .
7 ) (, , , .
Global Frame
Localization Problem
Relative Localization
10
Global Localization
11
Probabilistic Localization
12
)3 -1
.
.
.
.
.
.
)4 -1
)1-4 -1
. ) (, ,
) ( , , .
1 4
[ .]1
. 15
. .
.
[ . ]2
.
.
.
)2-4 -1
16
.
1 .
[.]3
.
Rotary Encoder
13
Gyroscope
14
Orientation
15
Global
16
Landmark
17
18
. GPS GPS
[ ]4 ( )
GPS
GPS
.
)3-4 -1
.
[ . ]5 ]6[ SLAM
. .
SLAM
.
.
1
Differential GPS
19
Kalman Filter
20
21
Non-Linear
22
States
23
[ .]4 4
[ . ]8
.
.
[.]8
Particle Filter
24
Particle
25
.2
)1 -2
.
.
.
.
1
.
.
.
.
Intelligent
26
Chernobyl
27
Unstructured
28
9
.
.
. :
. . .
.
. . .
.
. .
30
.
.1 .
.
.
.4 . . .
Dynamic
29
Noise
30
.
. . 1
.
.
.
.
)2 -2
)1-2 -2
.
( 1 ) .
[ . ]9
Real-time
31
32
.
.
11 .
.
. - 34
.
.
.
- []
:
()-
= )(
. 14 .
.
Kinematic
33
34
:
dr dl
()-
2
dr dl
()1-
= d
=
B
.
- []9
- . .
) (, , [:]
()4-
)
2
+1 = + ( +
()-
)
2
+1 = + ( +
()-
+1 = +
.
.
.
.
1 .
.
. ) ( , ,
) (, , . .
) (, , .
) ( , , .
.
:
+
()1-
:
()-
()9-
Differential
35
:
= +
()-
1- []
:
=
( ) =
()-
.
. /2 :
) = ( /2
()-
)( =
) = ( /2
)( = +
:
) = + ( + /2
()1-
) = () + ( +
])()( = + [() + ()() +
) = + ( + /2
()4-
) = + () ( +
])()( = + [() ()() +
() = 0
() = 1 . :
+
()-
()-
=
=
()1-
= +
()-
)( = +
()9-
)( = +
4- []
- =
) (, , .
.
.
- . .
()-
1
= + 2
2
()-
)( =
()-
)( =
. .
:
) ( = 1
()1-
()4-
= 2 + 2
.
[ ]9
.
, ,
. IMU1 [ ]1
IMU
.
IMU
.
)3 -2
)1-3 -2
34
.
- .
.
.
1 .
.
36
37
Indoor
38
19
UWD4 RF4 RFID4 .WLAN41
IR44 Active Badge .
IR [ . ]4 4
( ) IR
IR
.
. IR
.
IR
.
Infrared
39
Radio Frequency
40
41
42
43
Infrared
44
Badge
45
- []
41 RFID
. RFID 4 .49
.
.
.
.
.
RF WLAN
.Bluetooth
Scanner
46
Tag
47
Active
48
Passive
49
.
[ . ] WLAN
. 1
[ . ]
.
)2-3 -2
54
[ . ]
.
.
.
.
:
Time of Arrival
50
Angle of Arrival
51
52
Gaussian
53
Geometry Tracking
54
Landmark
55
.
.
.1
.4
[ . ]
1-
) : )
. .
.
1- []1
.
.
Sugihara [ ]
Thomson . [ ]9 .
1
.
Ozawa [ .]
Baist [ ]
1 .
Wendel [ ]
.
. - :
3 1 , 02 2 .
:
Genetic Algorithm
56
57 Hough .
Outdoor
58
= 1 0
()-
0 2 3 1 2 3 :
()-
2 + 2 = 0 2
()1-
2 + 2 = 1 2
= + :
0 2 1 2 + 2
=
2
()-
2 = 0 2 2 :
) 0 + (1 0
()9-
= 2
) 1 = ( 1 , 1 ) 2 = ( 2 , 2 ) 3 = ( 3 , 3 = 0
) (0 , 0 :
) 2 (1 0
) 2 (1 0
= 3
= 3
()1-
3 3 .
)4 -2
)1-4 -2
59
.
. .
(( 1 ), , , ) :
) ( ) = ( | , 1 , ) ( 1
) (
) ( ) = ( | ,
) (
[]8
.
( 1- . ) ( | ,
) ( | , 1 ,
. 1 .
[ .]8
)( .
Markov
59
Bayes
60
Actuation Commands
61
: (0 )
. 0 .:
1 0 = 0
0
()1-
{ = ) ( 0
.
(0 ) .
1-( 0 :11-(
1 ( 0 )2
}
2
2
()1-
()11-
( ) = (2 2 )2 {
1
1
}) ( 0 ) = det(2)2 { ( 0 0 ) 1 ( 0 0
2
) ( 0 ; 0 ,
.
. ) (0
:
1
||
()14-
= ) ( 0
|| 1 .
.
Point-mass Distribution
62
Lebesgue Measure
63
)5 -2
)1-5 -2
[ . ]1
.
[ . ]1
4 [ . ]8
.
9-
.
9- []2
. [ ]1
.
White Noise
64
Observer
65
.
. .
- .
- []2
[ .]2
- -
.
.
.
Gain
66
- []2
.3
)1 -3
.
[.]4
. 1
.
.
9
.
.
.
.
. :
()-1
) (1 , 2 20 .
Integration
67
Hydrodynamics
68
Maxwell
69
. .
1
1020
.
)2 -3
.
1 .
.
[ ] .
.
. .
.
.
.
.
.
.
11
70
.
.
[ . ]
.
.
)1 (MCL
[ .]1 MCL .
)3 -3
. .
.
.
.
.
.
.
14
71
.
.
.
.
1
.
. 11 .
) ( ) = ( | 0
()-1
0
. :
.
( )1-1
) ( ) = ( | , 1 , 1 , 2 . , 0 , 0
.
.
.
.
. 1-1
:
Markov
72
Belief
73
) ( | , 1 , , 0 )( | 1 , , 0
) ( | 1 , , 0
()4-1
= ) (
) ( | , 1 , , 0 )( | 1 , , 0
=
) ( | 1 , , 01
:
) | ( = ) ( | , 1 , , 0
()-1
( 4-1 :
) ( | )( | 1 , , 0
) ( | 1 , , 01
()-1
= ) (
1 1
()1-1
( | 1 , 1 , , 0 ) ( 1 | 1 , , 0 ) 1
) | (
) ( | 1 , , 01
1 1
1 , 1 1 , 1
2 :
()-1
) ( | 1 , 1 , , 0 ) = ( | 1 , 1
:
()9-1
) | (
( | 1 ,1 , , 0 )(1 )1
) ( | 1 , , 01
= ) ( 1
= ( | ) ( |1 ,1)( 1 )1
. MCL.
1
) | (
} = {i = 1. . 14
[.]
1 .1 ) | (
. ]9[11
[ ]1 . 1 .
:
: 1
1 :
( |1
) 1
) ( | 1
. 19
.
:
) = ( | .
:
11
Duality
74
Histogram
75
Kernel
76
Bootstrap
77
Particle Filter
78
Prime
79
j = 1. . : for
} draw one single ; from {1
( | ). .
.
= 0 } 0 = {0 (0 ). .
.
.
-1
-1
. .
-1
-1 .
. .
1-1
19
1-1
.
4-1
4-1 .
-1
-1
.
4
-1
-1
.
1-1
1-1 .
-1
-1
.
:
()
()
()
()
: = ( | )
: = +
/ Insert sample into sample se /
()
()
: = {{ , }}
/ Normalize importance weights /
for : = 1, , do
()
()
: = /
return
)( )(
.
.
. .
80
Importance Weights
41
.
. .
44
.4
)1 -4
. MCL
)( )( :
( ) = { () , () } = 1, ,
()-4
)( )(
.
() .
1 .
:
. 1 ) (1 () 1
) (1 . () 1
. () 1 1 )(
) . (|1 , 1
)(
) (|1 , 1 )(1 .
.1 )( ( )
) )( | ( )( .
.
) ( :
) = ( |1 , 1 )( 1
()-4
:
4
) ( | )( | 1 , 1 )( 1
) ( |01 , 1
()1-4
:
()4-4
) ( | )( | 1 , 1)( 1
) ( | 0 1 , 1
= [( | 1 , 1 ) ( 1 )] 1
) | ( =
) | (
:
()-4
( | 1 ) = ( |1 , 1 )( 1 | 1 )
:
) (| )( | 1
()-4
)2 -4
) (|1
= ) | (
KLD81
.
.
.
.
.
Kullback-Leibler distance
41
81
.
.
.
[ . ]1
.
[ . ]11 1
.
Leibler-Kullback MLE KLD
. Kullback-Leibler
. 83
.
.
. ) = (1 , , .
= (, ), = 1
82
Divergence
83
. = 1 . .
:
()1-4
=1
=1
4 .
2
2 log 1
as
()-4
( -4 KL ( , )
MLE .
:
()9-4
2
( ( , ) ) = (2( , ) 2) (1
) 2
( 9-4 ) ( , ( . -4
:
2
2
(1
1,1
) =1
()-4
2
1,1 ( 9-4 ( -4
2
:
()-4
( ( , ) ) = 1
:
1
()-4
2
= 2 1,1
1 K-L MLE
. ( -4 .
Hilferty-Wilson [:]14
:Chi-Square 84 .
49
()1-4
1 2
1
2
2
1,1
{1
+
}
2
2
)9( 1
9( 1) 1
1 ) (0,1
K-L . ( 1-4
. .
. ( 1-4
.
.
) ( |1 , 1 )(1 .
( 1-4
.
.
Proposal Distribution
85
()
()
Sample
(())
from ( |1 , 1 ) using 1
and 1
( )
( | )
: = + ()
/ Insert sample into sample se /
()
()
: = {{ , }}
/ Update number of bins with support /
()
if (
: = + 1
: = non empty
: = +1
1
2
while ( < 2 1,1
)
()
: = /
return
KLD
-4 :
-4
)3 -4
Kinect
.
]1[ Kinect
Xbox .
[ ]11 1
[ ]1 [ ]4 19 .
.
)4 -4
Kinect
RGB87 .
[ .]4
.
.
.
.
9 [ . ]4 9
Microsoft
86
87
Diffraction Grating
88
Disparity Image
89
Pixel
90
. -4
.
-4 ) (a (b) . ]4[ .
1-4
.
.
.
1-4 [ ]4 Kinect
.
. 9
9 . ( 4-4 ( -4 :
()4-4
()-4
=
=
.
( -4 ( 4-4 :
1 +
()-4
Image Space
91
Object Space
92
( -4 91
94 .
.
:
t
) ( +
()1-4
) = ( 0 +
0 x
.
Sebastian Zug [ ]41
Kinect
. 4-4
Kinect Hokuyo
Kinect
.
Disparity
93
Calibration
94
4-4 [.]41
)5 -4
Kinect ROS
-4 :
-4 Kinect []41
Kinect PR2 .
.
-4 ]41[ Kinect
-4
.
.5
)1 -5
.
.
.
PR295 MIT96 ROS97
.
.
.
)2 -5
ROS
Personal Robot 2
95
96
97
http://ros.org
98
99
ROS . Willow Garage101
.
ROS
. 1 4
.
. ROS
106 .
ROS Bag File .
)3 -5
Gazebo
.
.
ROS [ Gazebo ]4 .
. Gazebo1
. ROS
Packages
99
Nodes
100
http://www.willowgarage.com/
101
Topic
102
Publish
103
Subscribe
104
Message
105
Record
106
http://gazebosim.org
107
. ROS
ROS ROS
.
)4 -5
PR2
PR2 .
PR2 .
PR1 . Willow
Garage PR . .
1
IMU .
. ROS
ROS .
- PR2
Personal Robot
108
9
Intel Core i5-2435M .
Ubuntu 10.04 Fuerte ROS .
]4[ MIT
. ]41[ gmapping .
)5 -5
]41[ gmapping
]4[ amcl110 1
. amcl
.
Virtual Machine
109
110
1
. .
1- :
1-
.
.
.
P
.
4- .
E
.
4-
)Difference with Odom (m
Max Particles
Min Particles
172.1641
120
100
149.0521
1200
1000
149.0721
2200
2000
149.1893
3200
3000
149.0771
4200
4000
149.1321
5200
5000
149.1039
5000
100
75.96612
Variance
.
amcl
.
.
1/4
.
imresize()111 MATLAB112
. :
()-
= ( 2 1 )2 + (2 1 )2
1 1 2 2
.
.
111 .
112 MATLAB
.
49/ .
49/1 .
49/19
.
.
- S E
. P
.
.
.
- .
S E . 1
.
.
. 9/4111 .
/91 .
1/1 .
1/ . 1/1 .
)Difference with Odom (m
Max Particles
Min Particles
90.4373
120
100
18.9725
1200
1000
17.0361
2200
2000
17.0610
3200
3000
17.0729
4200
4000
17.0656
5200
5000
17.1007
5000
100
27.62038
Variance
. .
.
.
1 1 :
1 1
)Difference with Odom (m
Max Particles
Min Particles
51.8798
120
100
76.7163
1200
1000
56.0845
2200
2000
50.1452
3200
3000
41.9888
4200
4000
31.7900
5200
5000
30.8994
5000
100
15.80725
Variance
4 :
4 4
Max Particles
Min Particles
1059
120
100
892
1200
1000
894
2200
2000
878
3200
3000
861
4200
4000
896
5200
5000
981
5000
100
71.01643
Variance
1 4
.
.
)6 -5
.
.
.
.
1
.
.
.
Kinect
.
.
)4 -5
.
.
11
.6
Active
Actuation Commands
Angle of Arrival
Badge
Bayes
Belief
Calibration
Chernobyl
Dead Reckoning
Differential
Differential GPS
Diffraction Grating
Disparity
Disparity Image
Divergence
Duality
Dynamic
Fixed Frame
14
Gain
Gaussian
Genetic Algorithm
Geometry Tracking
Global
Global Frame
Global Localization
Gyroscope
Histogram
Hydrodynamics
Image Space
Importance Weights
Indoor
Infrared
Integration
Intelligent
Kalman Filter
Kinematics
Landmark
Laser Scanner
Lebesgue Measure
Localization Problem
Markov
Message
Nodes
Noise
Non-Linear
Observer
On-Board
Orientation
Outdoor
Packages
Particle
Particle Filter
Passive
Personal Robot
Pixel
Prime
Probabilistic Localization
Publish
Real-time
Record
Relative Localization
Rotary Encoder
Scanner
States
Subscribe
Tag
Time of Arrival
Topic
Unstructured
Virtual Machine
White Noise
11
.4
]1[
]2[
]3[
]4[
]5[
]6[
]7[
]8[
]9[
]11[
]11[
]12[
]13[
]14[
11
]15[ L. Zheng, "Indoor Wireless Local Area Networks (WLAN) Location System Using
a Kalman Filter," University of Manitoba, Manitoba2009 .
]16[ M. Betke and L. Gurvits, "Mobile robot localization using landmarks," in Intelligent
]17[
]18[
]19[
]21[
]21[
]22[
]23[
]24[
]25[
]26[
]27[
]28[
]29[
]31[
Robots and Systems '94. 'Advanced Robotic Systems and the Real World', IROS '94.
Proceedings of the IEEE/RSJ/GI International Conference on, 1994, pp. 135-142
vol.1.
J. M. Font-Llagunes and J. A. Batlle, "Consistent triangulation for mobile robot
localization using discontinuous angular measurements ",Robot. Auton. Syst., vol.
57, pp. 931-942, 2009.
K. Sugihara, "Some location problems for robot navigation using a single camera,"
Comput. Vision Graph. Image Process., vol. 42, pp. 112-129, 1988.
K. T. Sutherland and W. B. Thompson, "Inexact navigation," in Robotics and
Automation, 1993. Proceedings., 1993 IEEE International Conference on, 1993, pp.
1-7 vol.1.
R. Ozawa, Y. Mae, and M. Minami, "Localization of mobile robots by multip le
landmark recognition," in SICE, 2007 Annual Conference, 2007, pp. 1529-1535.
A. Baist, R. Sablatnig, and G. Novak, "Line-based landmark recognition for selflocalization of soccer robots," in Emerging Technologies, 2005. Proceedings of the
IEEE Symposium on, 2005, pp. 132-137.
A. Wendel, A. Irschara, and H. Bischof, "Natural landmark-based monocular
localization for MAVs," in Robotics and Automation (ICRA), 2011 IEEE
International Conference on, 2011, pp. 5792-5799.
P. S. Maybeck, Stochastic models, Estimation, and Control: Academic Press Inc.,
1979.
S. U. Nicholas Metropolis, "The Monte Carlo Method," Journal of the American
Statistical Association, vol. 44, pp. 335-341, 1949.
I. J. Cox, "Blanche-an experiment in guidance and navigation of an autonomous
robot vehicle," Robotics and Automation, IEEE Transactions on, vol. 7, pp. 193-204,
1991.
D. F. S. T. W. B. F. Dellaert, Particle Filters for Mobile Robot Localization, 2001.
S. Thrun, D. Fox, W. Burgard, and F. Dellaert, "Robust Monte Carlo localizatio n for
mobile robots ",Artificial Intelligence, vol. 128, pp. 99-141, 5// 2001.
A. F. M. Smith and A. E. Gelfand, "Bayesian Statistics without Tears: A Sampling
Resampling Perspective," The American Statistician, vol. 46, pp. 84-88, 1992/05/01
1992.
N. J. Gordon, D .J. Salmond, and A. F. M. Smith, "Novel approach to nonlinear/no nGaussian Bayesian state estimation," IEEE Proceedings F, Radar and Signal
Processing, pp. 107-113, 1993.
G. Kitagawa, "Monte Carlo filter and smoother for non-Gaussian nonlinear state
space models," Journal of computational and graphical statistics, vol. 5, pp. 1--25,
1996.
14
]31[ D. Fox, "KLD-Sampling: Adaptive Particle Filters and Mobile Robot Localizatio n, "
Department of Computer Science & Engineering University of Washington Seattle ,
WA 981952001.
]32[ D. Koller and R. Fratkina, "Using Learning for Approximation in Stochastic
Processes," presented at the Proceedings of the Fifteenth International Conference
on Machine Learning, 1998.
]33[ S. Thrun, J. C. Langford, and D. Fox, "Monte Carlo Hidden Markov Models:
Learning Non-Parametric Models of Partially Observable Stochastic Processes,"
presented at the Proceedings of the Sixteenth International Conference on Machine
Learning, 1999.
]34[ S. K. N. Johnson, and N. Balakrishnan, Continuous univariate distributions vol. 1:
John Wiley & Sons, 1994.
]35[ Microsoft. Kinect. Available: http://www.xbox.com/en-us/kinect/
]36[ S. Qi, T. Yanlong, H. Ping, and P. Jingliang, "Kinect-based automatic 3D highresolution face modeling," in Image Analysis and Signal Processing (IASP), 2012
International Conference on, 2012, pp. 1-4.
]37[ M. Camplani, T. Mantecon, and L. Salgado, "Depth-Color Fusion Strategy for 3-D
Scene Modeling With Kinect," Cybernetics, IEEE Transactions on, vol. 43, pp.
1560-1571.2113 ,
]38[ P. Rakprayoon, M. Ruchanurucks, and A. Coundoul, "Kinect-based obstacle
detection for manipulator," in System Integration (SII), 2011 IEEE/SICE
International Symposium on, 2011, pp. 68-73.
]39[ J. Rodrigues, C. Cardeira, F. Carreira, J. M. F .Calado, and P. Oliveira,
"Experimental validation of a visual odometry system for indoor unstructured
environments," in Advanced Robotics (ICAR), 2013 16th International Conference
on, 2013, pp. 1-6.
]41[ F. Steinbrucker, J. Sturm, and D. Cremers, "Real-time visual odometry from dense
RGB-D images," in Computer Vision Workshops (ICCV Workshops), 2011 IEEE
International Conference on, 2011, pp. 719-722.
]41[ B. Freedman, A. Shpunt, M. Machline, and Y. Arieli, "Depth mapping using
projected patterns," ed: Google Patents, 2010 .
]42[ K. Kourosh and E. Sander Oude, "Accuracy and Resolution of Kinect Depth Data
for Indoor Mapping Applications," Sensors, vol. 12, 2012.
]43[ S. Zug, F. Penzlin, A. Dietrich, N. Tran Tuan, and S. Albert, "Are laser scanners
replaceable by Kinect sensors in robotic applications?," in Robotic and Sensors
Environments (ROSE), 2012 IEEE International Symposium on, 2012, pp. 144-149.
]44[ C.
Rockey.
(2012).
depthimage_to_laserscan.
Availab le :
http://wiki.ros.org/depthimage_to_laserscan
]45[ M. University. (2011). MIT
STATA Center Data Set. Availab le :
https://projects.csail.mit.edu/stata/downloads.php
]46[ .)2114(Gazebo Simulator
Available: http://gazebosim.org/
]47[ B. Gerkey. gmapping. Available: http://wiki.ros.org/gmapping
]48[ B .Gerkey. amcl. Available: http://wiki.ros.org/amcl