Professional Documents
Culture Documents
!"!#! $! %!&
!" # #$% !
-
*
& 3
04
'
+
0'
&
&
"
"
%
'
, ,&
&* 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
k
y
Ri
y
t=k1
k
k
Ri
"
& ,
, 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 <
%
;,
, E< E
% &
,&
E
,
<
' !
0 34
% ;& $
' ;& $'
, '
+ !
& E
& .
F
,
*
, "
& ,&
%
5%
%
>
40
30
50
50
20
20
10
10
20
20
50
50
30
40
0
20
40
60
80
100
100cm distance travelled
40
50
100
150
200
200cm distance travelled
20
40
60
80
100cm distance travelled
100
50
100
150
200cm distance travelled
200
150
100
100
50
50
100
200
50
100
50
100
50
50
100
100
150
50
100
100
200
300
400
400cm distance travelled
200
0
!"
100
200
300cm distance travelled
300
200
400
400cm distance travelled
!"
9
>%
5 A !
B 2
1
,
'
&
'
'
&
%
,
,&
& , & ,&
2
&<
+
,&
,
&& & , 6
& =
,
,
,
6
,& B
!
H
+
&%
;& ,
&
*
*& ' , '
&'
, ' ,
& &
, * +
&, . *&
Sample Trajectory of an exploring Robot (*: Tracker, o: Odometer, .: Monte Carlo Samples)
450
700
Trs :3 cm/m
Rot :2 Deg/360Deg
400
Drft :2 Deg/m
600
350
500
300
Yaxis
400
300
250
200
200
150
100
100
0
50
100
400
300
200
100
100
200
300
400
500
100
600
200
300
400
500
600
700
Xaxis
!"
!"
,
'
+ !%
,& -
, &
"
^ m
x m ,y m
Observing RobotLaser
(Stationary)
dx= xm x s
dy= ymys
= dx2 +dy 2
^
w
x s,ys
^ s
^ =atan2(dy,dx)= ^ + ^
s
w
^ =atan2(dy,dx)= ^ + ^
m
w
^
Tracker Returns: < , , ^>
9 : 9
#:
A
$ % :
$ % :
C%
, 9
9
0, % ,
& *%
: #: % &
0 9
&%
A 5%% & =6 ?7
A
: A :%
9 A : A :%
A 5% 9
:
$ A : A :
#:
?%
A
9 : 9
#:
$ % :
$ % :
9 :
I%
, 9
9
,&
&
:
=6 H% +
=6 I
# 2
% % ,
=6 H
0
&
*
, ,
, ,&
% 9
5
$$
5
$$
5
$$
H%
;& >
=6 H
: #:% ,&&
*
'
,&&
, &
;
' & 9 # # #
& 9 5## 5## > ' & =6 C
0
: #:
2
9
=6 H
0& &
> %
=
,
% *
,
% )
'
0
* &
:%
&
% &
'
7
5#%
0 *
,&&
'
&
;& C'
;& C
,&&
;& C'
+
,&&
2
!
,&
& =6 55%
5
%
9
$$
5
$$
5
$$
55%
% 9
5
$$
5
$$
5$%
,&
7
, ,&%7
K 9
5#
B& " 7
9
K
)
& %%7
% 9 L %
" 7 .
'
,
,& &
1 ,
,
&
%
9
K
7
'
55
^
w
Observing RobotLaser
(Moving)
Observed RobotTarget
(Stationary)
m
x m ,y m
dx= x s x m
dy= y s y m
= dx2 +dy 2
x s,ys
^ =atan2(dy,dx)= ^+
w
m
^ =atan2(dy,dx)= ^+
w
s
^
^
Tracker Returns: < , , >
^ w
A
: 9
$ % :
#:
$ %
5%
:
, 9
9
%
& &%
0
: #: % 0, &
&
%
9
% & =6 5
A
#: A : %
9 A #: A : %
A 5% 9
:
$ A #: A :
:
5%
+
&
&
,&
, =6 H' 55' 5$
%&
'
5$
110
Stationary
Robot
Stationary
Robot
100
Tracker
100
90
80
80
70
60
60
50
Motion
40
40
Motion
30
20
20
10
Moving Robot
Moving Robot
0
20
40
60
80
100
120
20
!"
40
60
80
100
120
!"
120
120
Stationary
Robot
100
100
80
Stationary
Robot
80
60
40
Motion
60
Motion
Tracker
40
Motion
20
Motion
20
Moving Robot
20
Moving Robot
20
40
40
0
50
100
150
200
!"
50
100
150
200
!"
5
;& I
5 + /
+
' "+' 5HHC
C M /' N =' G ;&' B "
&7
6
' 5%7$5 $H' + 5HH?
? M / G6 & ;& "
*
' 5$C%7ICH II#'
5HHC
I . " /1
+ , - =, +
'
' 5HH
H M ! ' !
2' ; +
*
. %& ' 5C7$ ?' 5HHH
5# D0 .& !& G D
+
5
' B
/& ' ;' . )&
& '
1
! === ' M 5HHH
5 ; 0
' ;' B
/& ' . "
+
. G $
1 & &
. 2332 ===' " $##$
5> +
' E ; ' E
( )
' '
.& P
&' . .
=&& .
' M
$##5
5C (& 0 "
M0
' E
./E7 #>$5>CI?C> ! & ) ' " $###
5? (& 0 ! Q & P
1 ,
-
' "
' "E'
5HHC ===
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?
' Q
"
&
&
1
'
5' & 5 5I ===' 5HH>
$$ EM (' M .
' +;" . E
J &
5 ' 5#$%75#?
55' +
5HH
$ "
+, /
0 !
&
$ "
+, /
0
7 )&
,
&
0&
,0 6
! '
5' &
IH H#I' 5HHI
$>
M
' F
B-0' M +' " & + = &
&
1
*
0 1' & $>5I $>$' . ;
' !+' ).+' +
$###
$C
M
' F
&
& +
' E ; ' EM (' '
)
' .& P
&' M $##5
> ; G = "
(
&
& &
' 7 H' 5HH?
C ;& G = "
0,
& $
&
' & $H $?>' 5HHI
5C
-
! ' & >?$ >?I' 5HHH
I
"
D1 (& 0
& &
' . &' !+'
5HH ===
H "
0 '.
5H?H
'
5 +
' E, R0'
# 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
' + /
0' " ' M "
!
0 F-
1 /
! ' & 5#CI 5#?>' 5HHH
>$ . ' ;' B
/& ' ; 0
1
-
' 5#57HH 55' $##5
> E0 P
' / ,-' / D +
*
1
&
===' '
'
5' & ? 5$' " $##$
> ( B' ! B1
' =,
0 D&
0
&
& *
99=
'
5' &
>H> C#5 ===' 5HH
+ ,
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
,
&
7 6
,
'
& ,
'
*
%' ,
&'
C
&
/ ;
J0
;' '8%
? !& D
5# '8
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?%
E
%
=6 5>%' 0,
!
7 9 5 5%' ,
9 5
B ,
,
/
& ,
=6 5I%
&
,
,
&
(
! ;
1&
& =6 5H
7 9 5 % 9
7 9 5
5% 9
%
7 9 5 5%
7 9 5 5%
%
7 9 5
5I%
5%
5H%
+ ,
2
'
+
&
D
*
6
'
0
&
$5
'
B
,
&
>' ?' #'
,
( ;'
'
F &
,
,
V
%
8
.
8
,
,0
2
0 & F
2
'
& ,
,
& *
!
"
# $ %
&
+
,
2
' E
& .
, ,
$$
B
&
@* @+
& , &
'
,
&
,
!
!"
!"
&
0 % / % +
=
0,
& &&
&
,
3!4
&
,
0
,
3 ,4
! C
$ % "' ,
,
& 8 '
0
0
& ;& 5#%
0
,
&
( ,
$
,
$
$
0.6
0.4
0.2
0.2
0.4
0.6
50
40
30
20
10
0
10
Rotation angle (in degrees)
20
30
40
50
,
,
V
, ,
V
% ,
F
&*
&
; ;& 5 ,
& = &
2 '
,
;
6
&'
$
0.5
0.5
1.5
2
50
40
30
20
10
0
10
Rotation angle (in degrees)
20
30
40
50
0
;
,
& + 1 ( ,
6
&
&
0
!
, ;& H% , ,
+
2
, 2 +
,
0 +% , & 9 9 # # # %
;& 5>
5##
,
5C> 2
V% *
&
& O R W
5
2
2
$#' C#' 5##% &
5##
& &*
, & , '
5
Number of samples
Number of samples
6
4
2
4
3
2
1
0
0.4
0.2
0
0.2
Error in degrees (Carpet 1)
0
0.5
0.4
12
10
10
8
6
4
2
0
12
Number of samples
Number of samples
1
1.5
Error in degrees (Plastic 1)
8
6
4
2
0.5
1
Error in degrees (Carpet 2)
1.5
0.5
1
Error in degrees (Tile Floor)
1.5
;& 57 = 2
H# %
;'
1
!
'
&
&
, , &
&
&
(
*
& &
B
& ,
' '
6
" !
%
(
0
&
' ,'
&
,
$C
12
10
0
0.6
0.4
0.2
0
Error in degrees (Carpet 1)
0
2.5
0.2
2
1.5
Error in degrees (Plastic 1)
10
7
6
5
6
3
2
2
0
1
1
0.8
0.6
0.4
Error in degrees (Carpet 2)
0
1.5
0.2
1
Error in degrees (Tile Floor)
0.5
;& 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
2
1
0
1
Error in cm (E=0.0924 =0.7906)
0
2
Histogram of error in
1
0
1
Error in cm (E=0.3422 =0.6201)
30
25
1
20
Y
15
10
1
5
0
1
2
85
0.5
0
0.5
1
Error in degrees (E=0.0601 =0.3075)
90
95
X
100
105
@
%
9 A @ A
C#
$#%
!
"
&
&
, , , 0
7 *'
& ,
.
'
& & 6
/,
*
B
2
-
&
' &
&
'
1
6
,
,
;& 5I% ,
-
'
&
'
*
'
4 ( ; &
&& ,
9 A
A
' ,
$I
57 " .
& O'R
% W
&%
5##
2
9
A
9
A
%
A
%
9
% A
% A
$
% ,
% 9 # )
'
% 9
% 9
9 $
9
$5%
"
'
6
,
&
' ,
7 9 % -
7 ;& 5I
=6 $$
'
&
&
$H
Histogram of error in X
Histogram of error in Y
5
Number of samples
Number of samples
6
5
4
3
2
1
0
1
2
3
Error in cm (E=2.4488 =0.9003)
4
3
2
1
0
0.5
1
1.5
Error in cm (E=0.9771 =0.4167)
Histogram of error in
3
0
Number of samples
2
1
1
0
0.5
1
Error in cm (E=1.0867 =0.1810)
2
105
1.5
110
115
X
120
125
Plastic
A @ A
%
A
%
9 9 A @ A
% A
%
A A
$$%
9
+
,
A
9 # 1
9
$%
#
Histogram of error in X
Histogram of error in Y
10
Number of samples
10
Number of samples
12
8
6
4
6
4
2
2
0
4
3
2
1
0
Error in cm (E=1.4318 =0.8155)
0
1
0.5
0
0.5
1
Error in cm (E=0.5329 =0.3851)
Position of the Robot
Number of samples
Histogram of error in
0
0.5
1.5
2
105
0
0.5
1
1.5
Error in degrees (E=0.6308 =0.2508)
110
115
X
120
125
Carpet
9
%
9 A A % A A %
A A
9
9
%
A A A % A
% %
% 9
9
9
$%
2
i+1
x i+1,y i+1
+
Finishing Position
Starting Position
1
x i,yi
5
;& 5I7 F
' &
' * -'
%
&
& & 6
$>' , "# 5% , ( , 1
& 6
"# 5%
9 "# 5%
"# 5%
@
@
$
@
$>%
5
STD along the X axis
Standard Deviation
4.5
4
STD along the Y axis
3.5
3
STD of the orientation
2.5
10
15
Number of steps per translation
20
25
+
&
& ;& 5H
5####
& O ' R
&
O ##
' 2
&
$
&& & ,
&
, &
,& &&
,
,
" (
&
,
6
,&
' *
,&
'
E & F
&%%
# 5
;
,&' 6
'
,
<
' ,&
& &&
'
&& +
&
3
,
4
&
7
BE
9 5
S 9
B%<
. 9
9 EA5%< " #$
%&
9 %< '
& %
EA5% 9 5< 95< -95< " $
%
/ .
9-<
9A5<
-9-A5<
%
.
,
& +
&<
!
H
&
&
6
,
6
)&
&
&
E
# 5' , 6
E
# 5
*
&
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%<
%
$
& +
&<
' !
0 34
,
&
,& "
&
& &
& &
, &
, 2
&
1
C