Professional Documents
Culture Documents
Particle Tutorial
Particle Tutorial
!"!#! $! %!&
!" # #$% !
-
*
& 3
04
'
+
0'
&
&
"
5
"
%
'
, ,&
&* 6
*
+
,&
*
&
, 7
+
'
*
& &
&%'
&
2
'
8
,&
&% +
, *
%
,&
'
&
"
'
& 9 : %
9 "
3
4% 9 7 9 5
%'
,
'
&
,& % *
9 , 0, 9 5% ,
2
9
%
,'
2
,
&
,&
& 8
+
& 5
*
& ,
(
' , 0
2
;'
,& 9 %
<
'
9
% 7 9 5
% ' ' ,&
,,
&
,
2
& " 2
/
>' ? ,%' ,
(
+ @ @
,
,
' ;& 5% 8
$
+
#7 9 7 9 5
9 7 9 5
=
&%
9 A 5<
=.. %
%
9
%<
9 %<
9 5
%
9 : %
9.%
9 5
%
9 %
9 5 "%
9
;
+
&<
' !
0 34
A
: %
9 A : % 5%
: :
B
Æ :
( ,
%
!% &
: 9 : A Æ : A
Æ :% $%
t=k
y’ θk
Ri
∆y t=k−1
ρk
θ
θk
y
Ri
x ∆x x’
"
& ,
, 2
'
*
&
& ,
&
&
&
<
2
,
&
'
1
' ,
, &
Æ
& &
2
,
& =6 +
& $
,
9
%
9
%' $##
&
%' ##
,
%' ##
, &
7 .
77 <
77
Æ 9 <
9 5 "%
9 5 D% !
9 E
Æ Æ%<
9 E
Æ Æ%<
: 9 : A <
9 A Æ A
: %<
9 A Æ A : %<
9 E
Æ Æ%<
: 9 : A <
9 : <
%
;,
, E< E
% &
,&
E
,
<
' !
0 34
% ;& $
' ;& $'
, '
+ !
& E
& .
F
,
*
, "
& ,&
!
" %%
! 9 9
5
%
5% %
%%
>
Single step translation (σtrs=5, σdrf =1) Single step translation (σtrs=1, σdrf =5)
40
30
50 50
20 20
10
0 0 0 0
−10
−20 −20
−50
−50
−30
−40
−40
0 20 40 60 80 100 0 50 100 150 200 0 20 40 60 80 100 0 50 100 150 200
100cm distance travelled 200cm distance travelled 100cm distance travelled 200cm distance travelled
150
100
100 200
100
50
50 50 100
0 0
0 0
−50
−50
−100 −50 −100
−100 −150
−100 −200
50 100 150 200 250 300 0 100 200 300 400 0 100 200 300 0 200 400
300cm distance travelled 400cm distance travelled 300cm distance travelled 400cm distance travelled
!" !"
% 9 5 9 > Æ
9 >%
5 A !
B 2
1
,
'
&
'
'
&
%
,
,&
& , & ,&
2
&<
+
,&
,
&& & , 6
& =
,
,
,
6
,& B
!
H
+
&%
;& ,
&
*
*& ' , '
&'
, ' ,
& &
, * +
&, . *&
C
Reproducing Thruns results Sample Trajectory of an exploring Robot (*: Tracker, o: Odometer, .: Monte Carlo Samples)
450
700
σ Trs :3 cm/m
σ Rot :2 Deg/360Deg
400
600 σ Drft :2 Deg/m
350
500
300
400
Y−axis
250
300
200
200
150
100
100
0
50
−100 0 100 200 300 400 500 600 700
−400 −300 −200 −100 0 100 200 300 400 500 600 X−axis
!" !"
%'
-
,
'
+ !%
,& -
, &
+
%
0
&
*&
0
,
,&
&
J &
0
, 2
; , 6 ,
& *
$5%<
,
& *
& &
$$%
#
!
$
"
?
^φ
w
Observed Robot−Target
(Moving)
φ^ θ^ m
x m ,y m
Observing Robot−Laser
(Stationary)
dx= xm− x s
dy= ym−ys
x s,ys ^θ
w ρ = dx2 +dy 2
^θ =atan2(dy,dx)= ^ + ^
^θ s ^
θ w θ θs
^φ =atan2(−dy,−dx)= ^ + ^
w φ θm
^
Tracker Returns: < ρ, θ, φ^>
A
9 : 9
$ % : C%
#:
$ % :
, 9 9
0, % ,
& *%
0 9 : #: % &
&% A 5%% & =6 ?7
A
: A :%
A 5% 9 9 A : A :%
?%
: $ A : A : #:
=6 C ? 6
!6
' 6
,&
& ' & (
: #:%' , 2 , ;'
I
9 : 0,
9 :
0
& =6 I7
A
9 : 9
$ % : I%
#:
$ % :
, 9 9
,&
&
:
=6 H% +
=6 I
# 2
% % ,
=6 H
0
&
*
, ,
, ,&
5 5 5
% 9
H%
$$ $$ $$
;& >
=6 H
: #:% ,&&
*
'
,&&
, &
;
' & 9 # # #
& 9 5## 5## > ' & =6 C
0
: #:
2
9
=6 H
0& &
> % Æ
=
,
% *
,
% )
'
0
* &
:%
&
% &
'
7
0 *
,&&
'
&
;& C'
;& C
,&&
;& C'
+
,&&
2
!
,&
& =6 55%
5
% 9 5 5 ¼
55%
$$ $$ $$
H
;& >7
0 ,&&
&
: :
9 3 4
9
% A % &
8
5
% 9 5
5$%
$$ $$
,&
7
, ,&%7
K 9
5#
;& C7
0 ,&&
&
;& >
, ,
B& " 7
K 9
)
& %%7
% 9 L %
" 7 .
'
,
,& &
1 ,
,
&
%
7
'
K 9
55
^
θw
Observing Robot−Laser
^
(Moving) θ θm
x m ,y m
Observed Robot−Target
(Stationary) ρ
dx= x s − x m
dy= y s −y m
ρ = dx2 +dy 2
^ =atan2(dy,dx)= ^θ+ θ
φ^ w θw m
x s,ys ^ =atan2(−dy,−dx)= ^φ+ θ
φw s
θs φ^
^ ^
Tracker Returns: < ρ, θ, φ >
A
#: A : %
A 5% 9 9 A #: A : %
5%
: $ A #: A : :
+
&
&
,&
, =6 H' 55' 5$
%&
'
5$
110
Stationary Stationary
Robot Robot Tracker
100 100
90
80 80
70
60 60
50
40
Motion 40
Motion
30
20 20
10
!" !"
120 120
Stationary Stationary
100
Robot 100
Robot
80 80
60
Motion
60 Motion
40 40 Tracker
Motion
20 20 Motion
0 0 Moving Robot
Moving Robot
−20 −20
−40 −40
0 50 100 150 200 0 50 100 150 200
!" !"
5
;& I
5 + /
+
"
/
0 ;
0&
! ' I%7$5 $>' $###
> M /' N =' G ;& %& ' (
)
E ./E 5 >CII5 #>I O + D ' B
' "+' 5HHC
? M / G6 & ;& "
*
' 5$C%7ICH II#'
5HHC
H M ! ' !
2' ; +
*
. %& ' 5C7$ ?' 5HHH
5
55 + ! D M D 0
.
1 ,
' 5$%75C 5?C' " 5HH>
5$ ; 0
' B
/& ' ;' . )&
& '
1
! === ' M 5HHH
5 ; 0
' ;' B
/& ' . "
+
. G $
1 & &
. 2332 ===' " $##$
5> +
' E ; ' E
( )
' '
.& P
&' . .
=&& .
' M
$##5
5I G ;&' M /' N = B 7 .
&'
)" "=+" H $5' ) "
& ' + +'
) "
& ' + +' "' ).+'
5HH
5H ;0 ' .& ' ; + ' R R0 ' R +' D
0 ' R 0 E &
&
0
&
0
11
& %
'
$' & 5># 5>>'
5HH>
$# + (
4 " ' ! &' "
' 5H?
$5 ; (2 ' ! "
' " ' ( P
' Q
"
&
&
1
'
5' & 5 5I ===' 5HH>
$$ EM (' M .
' +;" . E
J &
5 ' 5#$%75#?
55' +
5HH
$ "
+, /
0 !
&
5>
$ "
+, /
0
7 )&
,
&
0&
,0 6
! '
5' &
IH H#I' 5HHI
B-0' M +' " & + = &
&
1
*
0 1' & $>5I $>$' . ;
' !+' ).+' +
$###
$?
=
D
+ ,
*
&
'7
8 ' I$. %7> >' 5HC#
$H D 1 . N .
& &
&
===' '
'
' & $IHC $H#' 5HHI
# D 1' .& N' .& E & ' E 0 . .
&
'
$'
& 5$5 5$C ===' +
5HHC
5 D 1 .& E & ! & ,
'
$' & 5$># 5$>? ==='
5HH
&
& +
' E ; ' EM (' '
)
' .& P
&' M $##5
> ; G = "
(
&
& &
' 7 H' 5HH?
5C
? M "
!
0 +, /
0 +
0&
-
! ' & >?$ >?I' 5HHH
I
"
D1 (& 0
& &
' . &' !+'
5HH ===
H "
0 '. '
5 +
' E, R0'
5H?H
# M& B "' !& D& 0' ; N D
2
&
-
,
J
T J
J
" 0
+
*
1
1 7 + 0
*
1 &
2333
' & $H>I $HC>' . ;
' !
' +
$$ $I $### ===
? .&
(& + /0
1 6
+
0+1' & 5?H
5II' D
5?
H . ! F
' >%7>C CI' B 5HIC
>5 M .
' + /
0' " ' M "
!
0 F-
1 /
! ' & 5#CI 5#?>' 5HHH
> E0 P
' / ,-' / D +
*
1
&
===' '
'
5' & ? 5$' " $##$
+ ,
0& + ,
.
+5 .
+$
,0
0&' .
+ ,
1
&
0, '
, & 2 -
&
+ 3
4 $#
"
'
*
&%
D
*
& $#' I' H
& '
6
' 2
'
' .' .
! ,0 &
& & 2 H' ># + =
D
*
& =D;%' ,
6
$' 55
= D
;
5I
0
1
& C' >' ? D 1
' 6 ,
& *'
1'
&
0 5' #' $H
,
' &
1
,
,
, ,
F
&
2
& &
5$' 5' $C' >'
5' & &
1
1 ,
& 0
% >$'
&
& $>
6 ,
$
*
&
V, &
6
$
0&
& -
6
?' >5
0&
& &%
& && &
'
C' 5C
,
,
,
&
7 6
,
'
& ,
'
*
%' ,
&'
C
&
/ ;
J0
;' '8%
? !& D
5# '8
, -
1
,
0 0,
5H' ' $5 +
6
,
0
&
1
1'
0
$
1
&
5H
&
.
&
& &% &
0
/
&
,0
;
(
6 ( D
*
$?' I' >
(
= D
;
=D;%
1&
6
H' ># ;
' (
, Æ
7 ,
&
& *
& , &
& , ,
6 &
&
(
$$%
9
9 : '
=
0
%
& =6 5>
9 ! % 5>%
*
, 2
!
< '
+ ! .
!%
2
:
+
6 % & =
9
6 5C
(
)
*+
$#
9( ) % 5C%
% 9 % %
5?%
!
9 5
B ,
,
/
& ,
=6 5I%
& ,
,
&
(
! ;
1&
& =6 5H
% 7 9 5 5%
7 9 5 % 9
5I%
7 9 5 5%
7 9 5 5% 9 % 7 9 5 5% 5H%
2
'
+
&
D
*
6
'
0
&
$5
'
B
,
&
>' ?' #'
,
( ;'
'
F &
,
,
V
%
8
.
8
,
,0
2
0 & F
2
'
& ,
,
& *
!
"
# $ %
&
+
,
2
' E
& .
, ,
$$
2
0 ,
,
B
&
@* @+
& , &
'
,
&
,
!
!" !"
&
0 % / % +
=
0,
& &&
&
,
3!4
&
,
0
,
3 ,4
! C
$ % "' ,
,
& 8 '
0
0
& ;& 5#%
0
,
&
( ,
$
,
$
$
#$ & B
2
&
' '
% 2
0.6
0.4
Error (in degrees)
0.2
−0.2
−0.4
−0.6
−50 −40 −30 −20 −10 0 10 20 30 40 50
Rotation angle (in degrees)
,
,
V
, ,
V
% ,
F
&*
&
; ;& 5 ,
& = &
2 '
,
;
6
&'
$
Error in Rotation from Intended Angle (for three different speeds)
1.5
0.5
Error (in degrees)
−0.5
−1
−1.5
−2
−50 −40 −30 −20 −10 0 10 20 30 40 50
Rotation angle (in degrees)
0
;
,
& + 1 ( ,
6
&
&
0
!
, ;& H% , ,
+
2
, 2 +
,
0 +% , & 9 9 # # # %
;& 5>
5##
,
5C> 2
V% *
&
& O R W
5
2
2
$#' C#' 5##% &
5##
& &*
, & , '
$>
Histogram of Error (E=0.0882 σ=0.0962) Histogram of Error (E=1.4055 σ=0.2934)
10 6
8 5
Number of samples
Number of samples
4
6
3
4
2
2 1
0 0
−0.4 −0.2 0 0.2 0.4 0.5 1 1.5 2
Error in degrees (Carpet 1) Error in degrees (Plastic 1)
10 10
Number of samples
Number of samples
8 8
6 6
4 4
2 2
0 0
0 0.5 1 1.5 0 0.5 1 1.5
Error in degrees (Carpet 2) Error in degrees (Tile Floor)
;& 57 = 2
H# %
Æ
;'
1
!
'
&
&
, , &
&
&
(
*
& &
B
& ,
' '
6
" !
%
(
0
&
' ,'
&
,
$C
Histogram of Error (E=−0.4557 σ=0.1334) Histogram of Error (E=−1.7205 σ=0.2564)
12 6
10 5
8 4
6 3
4 2
2 1
0 0
−0.6 −0.4 −0.2 0 0.2 −2.5 −2 −1.5 −1
Error in degrees (Carpet 1) Error in degrees (Plastic 1)
6
8
5
6 4
4 3
2
2
1
0 0
−1 −0.8 −0.6 −0.4 −0.2 −1.5 −1 −0.5
Error in degrees (Carpet 2) Error in degrees (Tile Floor)
;& 57 = 2 H# % Æ
,
&
;
&
,
( , 1
* (
& , (
& ,
2
& , &
,
V
!
+ , ,
$55
& ,
&
6 $#
-
./ 012
3
,
$
$?
Histogram of error in X Histogram of error in Y
30 25
25 20
20
15
15
10
10
5 5
0 0
−2 −1 0 1 2 −2 −1 0 1 2
Error in cm (E=0.0924 σ=0.7906) Error in cm (E=0.3422 σ=0.6201)
25
1
20
15 0
Y
10
−1
5
0 −2
−1 −0.5 0 0.5 1 85 90 95 100 105
Error in degrees (E=0.0601 σ=0.3075) X
@
9 A @ A
% $#%
C#
!
"
&
Æ
&
, , , 0
7 *'
& ,
.
'
& & 6
/,
*
B
2
-
&
' &
&
'
1
6
,
,
;& 5I% ,
-
'
&
'
*
'
4 ( ; &
&& ,
9 A
A
' ,
$I
57 " .
& O'R
% W
&%
5##
2
"
'
6
,
&
' ,
7 9 % -
7 ;& 5I
=6 $$
'
&
&
$H
Histogram of error in X Histogram of error in Y
7 5
6
4
Number of samples
Number of samples
5
4 3
3 2
2
1
1
0 0
0 1 2 3 4 0 0.5 1 1.5 2
Error in cm (E=2.4488 σ=0.9003) Error in cm (E=0.9771 σ=0.4167)
4
Number of samples
3
0
Y
2
−1
1
0 −2
0.5 1 1.5 105 110 115 120 125
Error in cm (E=1.0867 σ=0.1810) X
Plastic
A @ A
%
A
%
9 9 A @ A
% A
%
$$%
A
A
& B 1 (
, ,
, ( 6 $5% '
9 A
,
9 # 1
9 $%
#
Histogram of error in X Histogram of error in Y
12 10
10 8
Number of samples
Number of samples
8
6
6
4
4
2 2
0 0
−4 −3 −2 −1 0 1 −1 −0.5 0 0.5 1 1.5
Error in cm (E=−1.4318 σ=0.8155) Error in cm (E=0.5329 σ=0.3851)
6 1
4 0
Y
2 −1
0 −2
−0.5 0 0.5 1 1.5 105 110 115 120 125
Error in degrees (E=0.6308 σ=0.2508) X
Carpet
9
%% 9 # )
9 9
9
9
$%
Εθ 2
θ i+1
x i+1,y i+1
∆ρ+Ερ
Finishing Position
Starting Position
Εθ 1
x i,yi θi
5
;& 5I7 F
' &
' * -'
%
&
& & 6
$>' , "# 5% , ( , 1
& 6
"# 5% @
9 "# 5%
@
$
"# 5%
@
$>%
4.5
Standard Deviation
3.5
3
STD of the orientation θ
2.5
0 5 10 15 20 25
Number of steps per translation
+
&
& ;& 5H
5####
& O ' R
&
O ##
' 2
&
$
&& & ,
&
, &
,& &&
,
,
,&' 6
'
,
<
' ,&
& &&
'
&& +
&
3
,
4
&
7
BE
9 5
S 9
B%<
. 9
9 EA5%< " #$
%&
9 %< '
& %
EA5% 9 5< 95< -95< " $
%
/ .
9-<
9A5<
-9-A5<
%
.
,
& +
&<
7
BE
9 5
S 9
B%<
. 9
9
& EA5%%<
9
%<
/ 9
E 9 JEA5%< ( ()
95< -95< " $
%
/ .
9-<
9A5<
-9-A5<
%
# G
& +
&<
'
!
0 34
,
,
,& +
&
3
,
4
&
) *
,
& & 7
&
0&
&
7
BE
9 5 %
9
) 9 #<
9 5 E%
) 9 ) A
<
9 5 E%
9
95<
9 5 E%
5% %
9 5
%
9 <
9 A 5<
, 9 5%<
, %%"
9 <
9 A 5<
%
$
& +
&<
' !
0 34
,
&
,& "
&
& &
& &
, &
>
, 2
&
1
C