Project

General

Profile

Revision 930

Added by Chris Mar over 15 years ago

sample maps created by pushing the robot around a table (3 or 4 walls)

View differences:

trunk/code/projects/mapping/matlab/input_success_0.txt
1 
0 0 0.000000 -1 -1 -1 -1 447
2 
0 0 0.000000 -1 -1 -1 -1 421
3 
0 0 0.000000 -1 -1 -1 -1 421
4 
0 0 0.000000 -1 -1 -1 -1 434
5 
0 0 0.000000 -1 -1 -1 -1 421
6 
0 0 0.000000 -1 -1 -1 -1 421
7 
0 0 0.000000 -1 -1 -1 -1 386
8 
0 0 0.000000 -1 -1 -1 -1 421
9 
0 0 0.000000 -1 -1 -1 -1 421
10 
0 0 0.000000 -1 -1 -1 -1 434
11 
0 0 0.000000 -1 -1 -1 -1 421
12 
0 0 0.000000 -1 -1 -1 -1 447
13 
0 0 0.000000 -1 -1 -1 -1 447
14 
0 0 0.000000 -1 -1 -1 -1 421
15 
0 0 0.000000 -1 -1 -1 -1 421
16 
0 0 0.000000 -1 -1 -1 -1 421
17 
0 0 0.000000 -1 -1 -1 -1 421
18 
0 0 0.000000 -1 -1 -1 -1 408
19 
0 0 0.000000 -1 -1 -1 -1 421
20 
0 0 0.000000 -1 -1 -1 -1 421
21 
0 0 0.000000 -1 -1 -1 -1 447
22 
0 0 0.000000 -1 -1 -1 -1 421
23 
0 0 0.000000 -1 -1 -1 -1 447
24 
0 0 0.000000 -1 -1 -1 -1 478
25 
0 0 0.000000 -1 -1 -1 -1 478
26 
-26 0 0.458628 -1 -1 -1 -1 478
27 
-1 1 0.504788 512 -1 -1 -1 478
28 
14 6 0.504788 -1 -1 -1 -1 408
29 
25 12 0.507766 -1 -1 -1 -1 447
30 
51 25 0.543504 597 -1 -1 -1 408
31 
66 33 0.546482 447 -1 -1 -1 447
32 
92 47 0.564350 421 -1 -1 -1 421
33 
102 53 0.562861 375 -1 -1 -1 408
34 
113 59 0.558394 494 -1 -1 -1 375
35 
124 65 0.547971 356 -1 -1 -1 434
36 
134 71 0.546482 365 -1 -1 -1 408
37 
145 77 0.553927 421 -1 -1 -1 408
38 
153 81 0.562861 408 -1 -1 -1 408
39 
212 115 0.573284 375 -1 -1 -1 386
40 
272 151 0.573284 330 651 -1 -1 375
41 
308 171 0.561372 294 -1 -1 -1 338
42 
319 177 0.553927 294 623 -1 -1 347
43 
327 181 0.540525 294 574 -1 -1 315
44 
335 185 0.522657 288 434 -1 -1 322
45 
359 197 0.461606 288 494 -1 -1 288
46 
367 201 0.443737 276 408 -1 -1 288
47 
375 205 0.428847 288 552 -1 -1 265
48 
383 208 0.410978 294 574 -1 -1 270
49 
391 209 0.396088 301 462 -1 -1 265
50 
401 211 0.400555 294 623 -1 -1 250
51 
409 215 0.402044 276 597 -1 -1 241
52 
491 242 0.251650 365 552 651 -1 224
53 
503 242 0.212934 462 494 714 -1 224
54 
527 242 0.136993 -1 447 681 -1 221
55 
536 242 0.067007 307 408 -1 -1 217
56 
544 240 -0.052117 255 365 -1 -1 217
57 
548 236 -0.134015 386 494 -1 -1 224
58 
552 232 -0.205489 397 447 -1 -1 232
59 
556 228 -0.276964 347 512 -1 -1 245
60 
560 224 -0.348438 347 478 574 -1 255
61 
571 205 -0.558394 307 494 -1 -1 375
62 
583 182 -0.888964 386 -1 -1 -1 330
63 
587 170 -0.918745 375 -1 -1 -1 347
64 
591 158 -0.939591 307 714 -1 -1 365
65 
595 147 -0.967883 347 681 -1 -1 375
66 
599 137 -0.978307 386 714 -1 -1 375
67 
604 126 -0.985752 397 651 -1 -1 375
68 
608 118 -1.006599 347 623 -1 -1 375
69 
610 110 -1.025956 397 651 -1 -1 356
70 
611 102 -1.039358 386 751 -1 -1 356
71 
614 86 -1.075095 322 597 -1 -1 347
72 
618 75 -1.097430 397 681 -1 -1 330
73 
622 63 -1.116788 408 714 -1 -1 301
74 
626 51 -1.140612 408 597 -1 -1 322
75 
630 39 -1.152525 447 -1 -1 -1 330
76 
648 -13 -1.183795 434 623 -1 -1 322
77 
655 -31 -1.186773 478 714 681 -1 322
78 
659 -43 -1.200174 494 623 714 -1 322
79 
664 -58 -1.207619 447 651 714 -1 307
80 
668 -70 -1.212087 478 623 681 -1 315
81 
691 -144 -1.293984 -1 447 574 -1 301
82 
692 -159 -1.302918 -1 434 478 -1 301
83 
692 -171 -1.316320 386 386 478 -1 301
84 
692 -179 -1.326743 294 365 421 -1 288
85 
692 -187 -1.332699 270 330 408 -1 301
86 
693 -197 -1.335677 260 301 408 -1 288
87 
696 -217 -1.346100 245 294 347 -1 294
88 
696 -225 -1.365458 260 276 356 -1 288
89 
696 -233 -1.384816 288 250 347 -1 294
90 
696 -238 -1.413108 294 241 338 -1 301
91 
696 -242 -1.471181 288 237 356 -1 288
92 
696 -246 -1.538188 276 228 408 -1 301
93 
695 -247 -1.585838 250 228 421 -1 294
94 
693 -247 -1.591794 255 221 447 -1 301
95 
693 -247 -1.591794 255 224 512 478 301
96 
691 -247 -1.602217 245 224 434 -1 301
97 
687 -248 -1.645400 237 228 478 -1 301
98 
679 -257 -1.849400 197 241 -1 -1 347
99 
675 -261 -1.944699 189 250 -1 -1 408
100 
631 -275 -2.632639 241 -1 -1 -1 221
101 
626 -275 -2.678799 260 -1 -1 -1 207
102 
618 -275 -2.730916 294 -1 -1 -1 203
103 
608 -275 -2.784522 315 -1 -1 -1 191
104 
569 -275 -2.867909 408 -1 -1 -1 197
105 
554 -275 -2.884289 512 -1 -1 -1 207
106 
476 -286 -2.881311 623 -1 -1 -1 213
107 
464 -286 -2.873865 375 -1 -1 -1 217
108 
443 -289 -2.876844 512 -1 -1 -1 217
109 
428 -290 -2.881311 494 -1 -1 -1 224
110 
406 -293 -2.881311 552 -1 -1 -1 224
111 
393 -294 -2.872377 574 -1 -1 -1 232
112 
356 -296 -2.854508 386 -1 651 -1 237
113 
342 -297 -2.855997 623 -1 -1 -1 245
114 
327 -298 -2.869398 597 -1 -1 -1 241
115 
315 -298 -2.875355 552 -1 -1 -1 255
116 
295 -301 -2.872377 552 -1 -1 -1 245
117 
268 -303 -2.864932 597 -1 -1 -1 245
118 
256 -303 -2.861953 421 -1 -1 -1 228
119 
241 -305 -2.864932 512 -1 -1 -1 237
120 
234 -305 -2.884289 -1 -1 -1 -1 255
121 
232 -305 -2.891735 -1 -1 -1 -1 255
122 
232 -305 -2.891735 397 -1 597 -1 260
123 
223 -305 -2.875355 397 -1 -1 -1 255
124 
222 -305 -2.872377 552 -1 -1 -1 250
125 
220 -305 -2.869399 408 -1 -1 -1 260
126 
182 -307 -2.854508 574 -1 681 -1 260
127 
170 -307 -2.842596 512 751 -1 -1 265
128 
157 -307 -2.835150 434 -1 -1 -1 260
129 
143 -307 -2.827705 462 651 -1 -1 255
130 
125 -308 -2.832172 597 552 -1 -1 447
131 
47 -313 -2.878333 -1 681 -1 -1 265
132 
11 -313 -2.942363 751 623 651 -1 276
133 
-70 -315 -3.080844 -1 714 -1 -1 294
134 
-80 -315 -3.153808 -1 -1 -1 -1 301
135 
-88 -311 -3.232727 -1 434 -1 -1 301
136 
-98 -306 -3.345895 375 375 -1 -1 213
137 
-103 -302 -3.462041 322 -1 -1 -1 597
138 
-111 -297 -3.607968 347 -1 -1 -1 -1
139 
-119 -289 -3.767297 288 -1 -1 -1 -1
140 
-134 -262 -4.215501 -1 -1 -1 -1 356
141 
-134 -254 -4.322713 -1 -1 -1 -1 307
142 
-134 -246 -4.412055 -1 -1 -1 -1 315
143 
-134 -238 -4.485019 -1 -1 -1 -1 375
144 
-134 -234 -4.532669 -1 -1 -1 -1 386
145 
-134 -226 -4.590742 -1 -1 -1 -1 347
146 
-134 -225 -4.595209 -1 -1 -1 -1 338
147 
-134 -225 -4.595209 -1 -1 -1 -1 338
148 
-134 -222 -4.607122 -1 -1 -1 -1 347
149 
-134 -218 -4.632436 -1 -1 -1 -1 330
150 
-134 -214 -4.645837 -1 -1 -1 -1 315
151 
-134 -205 -4.610100 -1 -1 -1 -1 330
152 
-134 -193 -4.556494 -1 -1 -1 -1 356
153 
-135 -103 -4.443324 -1 681 -1 -1 365
154 
-139 -32 -4.418008 -1 494 -1 -1 447
155 
-141 -15 -4.419497 -1 494 -1 -1 447
156 
-144 33 -4.595206 574 375 -1 -1 -1
157 
-144 37 -4.620520 623 447 -1 -1 -1
158 
-144 41 -4.653279 552 434 -1 -1 -1
159 
-144 45 -4.696462 421 421 -1 -1 -1
160 
-142 49 -4.742622 462 434 -1 -1 -1
161 
-138 53 -4.763469 421 397 -1 -1 -1
162 
-134 57 -4.788783 421 447 -1 -1 -1
163 
-130 61 -4.828987 408 434 -1 -1 -1
164 
-126 65 -4.882593 386 408 -1 -1 -1
165 
-122 69 -4.946622 307 447 751 -1 -1
166 
-118 73 -5.037454 330 494 651 -1 -1
167 
-105 86 -5.332286 330 -1 -1 -1 681
168 
-101 90 -5.418651 347 714 -1 -1 597
169 
-96 92 -5.493103 338 -1 -1 -1 478
170 
-92 92 -5.534796 356 -1 -1 -1 478
171 
-89 92 -5.548198 408 597 -1 -1 408
172 
-88 92 -5.551176 365 -1 -1 -1 421
173 
-88 92 -5.551176 375 -1 -1 -1 447
174 
-88 92 -5.551176 408 -1 -1 -1 408
175 
-88 92 -5.551176 356 -1 -1 -1 447
176 
-88 92 -5.551176 421 714 -1 -1 397
177 
-88 92 -5.551176 386 -1 -1 -1 434
178 
-84 92 -5.580957 421 -1 -1 -1 434
179 
-80 92 -5.621161 462 -1 -1 -1 408
180 
-72 95 -5.603293 365 -1 -1 -1 397
181 
-34 116 -5.646475 408 651 -1 -1 375
182 
14 143 -5.655410 397 -1 -1 -1 375
183 
24 152 -5.682213 478 751 -1 -1 356
184 
70 176 -5.725397 397 -1 -1 -1 330
185 
83 184 -5.723907 408 -1 -1 -1 322
186 
147 217 -5.759645 322 714 -1 -1 301
187 
303 286 -6.047032 315 447 651 -1 237
188 
311 286 -6.115528 255 408 -1 -1 250
189 
319 286 -6.187002 347 552 -1 -1 260
190 
327 286 -6.270389 447 494 -1 -1 265
191 
335 283 -6.344841 356 447 -1 -1 265
192 
346 279 -6.405892 386 447 751 -1 315
193 
380 263 -6.642651 288 478 -1 478 552
194 
393 250 -6.880898 301 -1 -1 -1 301
195 
393 247 -6.895789 315 -1 -1 -1 322
196 
393 247 -6.895789 347 -1 -1 -1 338
197 
393 246 -6.898767 338 -1 -1 -1 330
198 
393 242 -6.930037 315 -1 -1 -1 356
199 
397 234 -7.037249 356 -1 -1 -1 408
200 
401 226 -7.120636 375 651 -1 -1 356
201 
405 215 -7.144460 375 552 -1 -1 375
202 
411 201 -7.145949 386 714 -1 -1 356
203 
415 189 -7.160840 434 651 -1 -1 365
204 
441 141 -7.172752 375 681 -1 -1 347
205 
445 131 -7.175731 408 623 -1 -1 347
206 
450 120 -7.175731 386 623 -1 -1 307
207 
467 83 -7.195090 356 651 -1 -1 330
208 
472 71 -7.199557 386 623 -1 -1 347
209 
480 55 -7.190623 386 552 -1 -1 330
210 
488 39 -7.223382 375 651 751 -1 322
211 
496 23 -7.263586 365 623 681 -1 315
212 
504 7 -7.272521 397 574 623 -1 301
213 
521 -26 -7.311236 397 447 597 -1 301
214 
525 -34 -7.323149 447 478 512 -1 322
215 
539 -70 -7.570331 315 375 751 -1 270
216 
539 -83 -7.851760 365 397 -1 -1 301
217 
536 -87 -7.923234 338 397 -1 -1 322
218 
532 -87 -7.957482 338 447 -1 -1 322
219 
532 -87 -7.957482 338 434 -1 -1 330
220 
532 -87 -7.957482 322 421 -1 -1 322
221 
532 -87 -7.957482 338 408 -1 -1 338
222 
530 -87 -7.967906 330 421 -1 -1 338
223 
528 -87 -7.979818 330 288 -1 -1 330
224 
523 -87 -8.039379 322 447 -1 -1 356
225 
519 -87 -8.079584 315 447 -1 -1 397
226 
503 -97 -8.292520 294 714 -1 -1 301
227 
491 -109 -8.361018 307 623 -1 -1 315
228 
484 -114 -8.389311 294 -1 -1 -1 347
229 
476 -122 -8.416115 301 -1 -1 -1 386
230 
468 -130 -8.436962 288 -1 -1 -1 397
231 
460 -138 -8.472698 260 -1 -1 -1 386
232 
404 -178 -8.605226 288 -1 -1 -1 330
233 
368 -202 -8.681170 301 -1 -1 -1 270
234 
300 -242 -8.788383 338 -1 -1 -1 276
235 
216 -283 -8.940269 751 -1 -1 -1 255
236 
45 -304 -9.272333 -1 -1 -1 -1 356
237 
-2 -304 -9.419749 462 -1 -1 -1 386
238 
-15 -291 -9.562700 -1 -1 -1 -1 681
239 
-24 -279 -9.719050 623 -1 -1 -1 -1
240 
-47 -261 -9.946877 574 -1 -1 -1 -1
241 
-92 -204 -10.377212 -1 623 -1 -1 421
242 
-100 -129 -11.008571 714 -1 -1 -1 -1
243 
-96 -121 -11.114294 512 -1 -1 -1 -1
244 
-92 -113 -11.225973 574 -1 -1 -1 -1
245 
-88 -105 -11.334674 -1 -1 -1 -1 -1
246 
-72 -79 -11.669713 -1 -1 -1 -1 651
247 
-66 -73 -11.757567 -1 -1 -1 -1 623
248 
-62 -69 -11.806705 -1 -1 -1 -1 597
249 
-60 -67 -11.815639 -1 -1 -1 -1 623
250 
-60 -67 -11.815639 -1 -1 -1 -1 597
251 
-60 -67 -11.815639 -1 -1 -1 -1 681
252 
-60 -67 -11.815639 -1 -1 -1 -1 597
253 
-60 -67 -11.815639 -1 -1 -1 -1 552
254 
-60 -67 -11.815639 -1 -1 -1 -1 597
255 
-60 -67 -11.815639 -1 -1 -1 714 597
256 
-60 -67 -11.815639 -1 -1 -1 -1 597
257 
-60 -67 -11.815639 -1 -1 -1 -1 597
258 
-60 -67 -11.815639 -1 -1 -1 -1 651
259 
-60 -67 -11.815639 -1 -1 -1 -1 597
260 
-60 -67 -11.815639 -1 -1 -1 -1 552
261 
-58 -65 -11.823085 -1 -1 -1 -1 597
trunk/code/projects/mapping/matlab/input_obstacle_0.txt
1 
40 0 0.375241 494 -1 -1 -1 -1
2 
40 0 0.375241 421 -1 -1 -1 -1
3 
40 0 0.375241 512 -1 751 -1 -1
4 
40 0 0.375241 447 -1 552 -1 -1
5 
40 0 0.375241 375 -1 597 -1 -1
6 
40 0 0.375241 462 -1 623 -1 -1
7 
40 0 0.375241 462 -1 -1 -1 -1
8 
40 0 0.375241 462 -1 -1 -1 -1
9 
40 0 0.375241 478 -1 -1 -1 -1
10 
40 0 0.375241 397 -1 -1 -1 -1
11 
40 0 0.366307 421 -1 -1 -1 -1
12 
40 0 0.366307 421 -1 574 -1 -1
13 
40 0 0.366307 447 -1 -1 -1 -1
14 
40 0 0.366307 421 -1 -1 -1 -1
15 
40 0 0.366307 434 -1 -1 -1 -1
16 
40 0 0.366307 421 -1 -1 -1 -1
17 
40 0 0.366307 397 -1 -1 -1 -1
18 
40 0 0.366307 421 -1 -1 -1 -1
19 
40 0 0.366307 478 -1 -1 -1 -1
20 
40 0 0.366307 494 -1 -1 -1 -1
21 
40 0 0.366307 421 -1 -1 -1 -1
22 
40 0 0.366307 462 -1 -1 -1 -1
23 
40 0 0.366307 478 -1 -1 -1 -1
24 
40 0 0.366307 386 -1 -1 -1 -1
25 
40 0 0.366307 462 -1 -1 -1 -1
26 
40 0 0.366307 462 -1 -1 -1 -1
27 
40 0 0.366307 408 -1 -1 -1 -1
28 
40 0 0.366307 494 -1 -1 -1 -1
29 
40 0 0.366307 397 -1 -1 -1 -1
30 
40 0 0.366307 462 -1 681 -1 -1
31 
40 0 0.366307 421 -1 512 -1 -1
32 
40 0 0.366307 512 -1 -1 -1 -1
33 
40 0 0.376730 462 -1 751 -1 -1
34 
40 0 0.396088 552 -1 -1 -1 -1
35 
40 0 0.433314 494 -1 -1 -1 -1
36 
41 0 0.442248 434 -1 -1 -1 -1
37 
48 0 0.305256 -1 -1 -1 -1 -1
38 
48 0 0.305256 447 -1 681 -1 -1
39 
48 0 0.375241 714 -1 -1 -1 -1
40 
48 0 0.381197 714 -1 -1 -1 -1
41 
48 0 0.335037 751 -1 -1 -1 -1
42 
48 0 0.294832 -1 -1 -1 -1 -1
43 
48 0 0.282920 478 -1 -1 -1 -1
44 
51 0 0.315679 -1 -1 -1 -1 -1
45 
76 2 0.309723 494 -1 -1 -1 -1
46 
80 2 0.288876 574 -1 -1 -1 -1
47 
85 2 0.266540 434 -1 -1 -1 -1
48 
88 2 0.262073 434 -1 -1 -1 -1
49 
93 2 0.265051 552 -1 -1 -1 751
50 
97 2 0.275474 552 -1 -1 -1 -1
51 
102 2 0.266540 462 -1 -1 -1 -1
52 
106 2 0.251650 365 -1 -1 -1 -1
53 
110 2 0.239737 552 -1 -1 -1 -1
54 
114 2 0.230803 462 -1 -1 -1 -1
55 
133 2 0.233781 408 -1 -1 -1 -1
56 
182 5 0.190598 -1 -1 -1 -1 -1
57 
195 6 0.187620 -1 -1 -1 -1 -1
58 
200 6 0.181664 -1 -1 -1 -1 -1
59 
204 6 0.174219 -1 -1 623 -1 -1
60 
209 6 0.168263 -1 -1 -1 -1 -1
61 
215 6 0.166774 -1 -1 -1 -1 -1
62 
222 6 0.172730 -1 -1 -1 -1 -1
63 
226 6 0.183153 -1 -1 -1 -1 -1
64 
234 6 0.187620 -1 -1 -1 -1 -1
65 
240 6 0.190598 -1 -1 -1 -1 -1
66 
253 7 0.186131 -1 -1 -1 -1 -1
67 
257 7 0.174219 -1 -1 -1 -1 -1
68 
266 7 0.151883 -1 -1 -1 -1 597
69 
344 8 0.145927 -1 681 -1 -1 270
70 
351 8 0.138481 -1 681 -1 -1 270
71 
367 8 0.126569 -1 623 -1 -1 270
72 
376 8 0.125080 -1 597 681 751 270
73 
391 9 0.123591 -1 552 -1 -1 276
74 
395 9 0.125080 -1 574 -1 -1 276
75 
405 9 0.126569 -1 512 -1 -1 265
76 
414 9 0.129547 -1 512 -1 -1 270
77 
422 9 0.134014 -1 462 -1 -1 276
78 
428 9 0.132525 -1 512 681 -1 276
79 
434 9 0.132525 -1 462 -1 -1 255
80 
439 9 0.142949 -1 494 751 -1 265
81 
443 9 0.154861 -1 478 408 -1 270
82 
447 9 0.172730 -1 494 512 -1 270
83 
451 9 0.189109 -1 462 512 -1 276
84 
463 9 0.230803 -1 478 228 -1 301
85 
465 9 0.248671 -1 408 294 -1 265
86 
475 9 0.279941 -1 421 322 -1 260
87 
477 9 0.290365 751 421 338 -1 301
88 
477 9 0.311212 -1 375 338 -1 301
89 
477 9 0.340993 -1 386 315 -1 301
90 
478 9 0.373752 -1 408 315 -1 288
91 
482 9 0.402044 -1 397 307 -1 307
92 
487 9 0.434803 -1 434 294 -1 322
93 
490 9 0.457139 651 434 294 -1 322
94 
490 9 0.500321 -1 408 276 -1 330
95 
490 9 0.521168 -1 397 270 512 322
96 
490 9 0.546482 -1 421 276 -1 322
97 
492 9 0.616467 -1 408 265 -1 386
98 
492 9 0.626891 -1 447 255 -1 386
99 
492 9 0.634336 -1 447 250 681 375
100 
492 9 0.643270 -1 447 241 -1 347
101 
493 9 0.658161 -1 478 232 -1 375
102 
496 9 0.677518 -1 421 232 681 375
103 
500 9 0.748993 -1 478 228 -1 447
104 
500 9 0.766861 -1 421 221 -1 375
105 
500 9 0.784730 -1 552 217 494 447
106 
501 11 0.830890 -1 714 213 375 478
107 
501 11 0.829401 -1 574 210 397 421
108 
501 11 0.829401 -1 494 213 386 478
109 
501 11 0.829401 -1 623 213 338 478
110 
501 11 0.829401 -1 651 217 386 494
111 
501 11 0.829401 -1 714 221 322 552
112 
501 11 0.829401 -1 574 210 386 574
113 
501 11 0.829401 -1 597 210 356 552
114 
501 11 0.829401 -1 597 221 386 552
115 
501 11 0.829401 -1 552 217 338 494
116 
501 11 0.829401 -1 651 200 347 447
117 
501 11 0.829401 -1 681 221 386 512
118 
501 11 0.829401 -1 623 221 375 574
119 
501 11 0.829401 -1 597 217 386 421
120 
501 11 0.829401 -1 512 217 375 447
121 
501 11 0.829401 -1 681 221 365 447
122 
501 11 0.829401 -1 681 221 386 597
123 
501 11 0.829401 -1 494 213 365 552
124 
501 11 0.829401 -1 681 213 375 574
125 
501 11 0.829401 -1 597 217 347 512
126 
501 11 0.829401 -1 597 217 356 574
127 
501 11 0.829401 -1 574 221 375 552
128 
501 11 0.829401 -1 623 203 386 512
129 
501 11 0.829401 -1 751 213 338 478
130 
501 11 0.829401 -1 651 213 375 478
131 
501 11 0.829401 -1 597 221 386 552
132 
501 11 0.829401 -1 574 210 365 512
133 
501 11 0.829401 -1 714 221 408 478
134 
501 11 0.829401 -1 714 213 307 494
135 
501 11 0.829401 -1 623 217 356 552
136 
501 11 0.829401 -1 512 210 386 434
137 
501 11 0.829401 -1 552 221 397 447
138 
501 11 0.829401 -1 552 213 386 623
139 
501 11 0.829401 -1 623 217 386 478
140 
501 11 0.829401 -1 494 210 375 478
141 
501 11 0.829401 -1 574 224 365 447
142 
501 11 0.829401 -1 623 217 375 478
143 
501 11 0.829401 -1 623 207 365 512
144 
501 11 0.875562 -1 714 217 356 552
145 
503 18 0.869606 -1 623 197 347 574
146 
504 22 0.859183 -1 651 203 338 421
147 
22088 16228 0.000000 189 307 408 32281 6400
148 
514 36 0.939591 -1 681 173 270 434
149 
514 36 0.952992 -1 397 171 260 397
150 
514 37 0.967883 -1 494 176 255 397
151 
514 41 0.979795 -1 494 173 245 478
152 
516 59 1.009576 -1 434 171 217 421
153 
517 60 1.018510 -1 347 164 217 447
154 
517 60 1.027445 -1 288 171 213 347
155 
517 61 1.039357 -1 397 169 207 447
156 
517 61 1.054247 -1 397 166 203 447
157 
517 61 1.049780 -1 288 171 197 494
158 
517 61 0.994686 -1 322 158 189 347
159 
517 61 0.982773 -1 330 166 191 356
160 
517 61 0.933635 -1 408 156 181 255
161 
517 61 0.924700 -1 347 154 194 255
162 
517 61 0.918744 -1 356 154 197 255
163 
517 61 0.918744 -1 338 154 189 232
164 
517 61 0.918744 -1 322 156 197 241
165 
517 61 0.918744 -1 375 154 194 260
166 
517 61 0.918744 -1 288 154 197 250
167 
517 61 0.918744 -1 265 154 197 260
168 
517 61 0.918744 -1 315 152 194 228
169 
517 61 0.918744 -1 386 154 194 260
170 
517 61 0.918744 -1 276 149 197 250
171 
517 61 0.918744 -1 356 151 197 260
172 
517 61 0.918744 -1 307 147 194 260
173 
517 61 0.918744 -1 301 152 197 255
174 
517 61 0.918744 -1 397 154 181 260
175 
517 61 0.918744 -1 330 154 197 255
176 
517 61 0.918744 -1 270 152 189 255
177 
517 62 0.985752 -1 -1 169 183 347
178 
517 62 1.025956 -1 -1 173 171 651
179 
517 62 1.046803 -1 -1 189 169 574
180 
517 62 1.081051 -1 -1 183 166 -1
181 
517 65 1.095941 -1 -1 191 164 714
182 
521 73 1.103386 -1 -1 203 173 -1
183 
525 81 1.131678 -1 -1 213 241 421
184 
528 132 1.232933 -1 714 270 147 288
185 
532 176 1.261225 -1 681 265 144 265
186 
533 202 1.274626 -1 552 260 158 255
187 
535 221 1.296962 -1 552 224 160 294
188 
535 221 1.296962 -1 512 224 156 288
189 
535 226 1.322276 -1 447 203 160 294
190 
535 230 1.338655 -1 512 224 164 288
191 
535 234 1.343123 -1 494 237 171 294
192 
535 241 1.347590 -1 462 294 169 265
193 
535 245 1.356524 -1 408 434 173 288
194 
535 251 1.378860 -1 421 494 173 294
195 
535 268 1.429487 -1 386 338 191 294
196 
535 272 1.430976 -1 375 356 197 288
197 
535 277 1.444378 -1 365 322 191 288
198 
535 281 1.466713 -1 375 294 203 301
199 
535 285 1.497983 -1 356 294 207 301
200 
535 289 1.532231 -1 338 276 217 315
201 
535 293 1.578392 408 365 260 232 322
202 
530 298 1.630508 681 347 260 241 330
203 
526 302 1.679647 -1 375 237 260 347
204 
522 306 1.716873 -1 338 245 260 375
205 
518 310 1.737720 -1 386 245 288 386
206 
514 314 1.754099 -1 330 228 288 347
207 
510 323 1.757077 -1 375 213 294 338
208 
506 329 1.768990 -1 375 210 294 365
209 
502 334 1.813661 -1 356 200 260 386
210 
498 342 1.885136 -1 434 200 270 421
211 
478 369 2.063822 -1 -1 176 301 -1
212 
474 373 2.107005 -1 552 178 260 -1
213 
442 393 2.206772 -1 408 178 213 -1
214 
434 398 2.221662 -1 330 181 197 -1
215 
394 421 2.342276 -1 -1 191 166 -1
216 
386 425 2.358656 -1 -1 200 166 -1
217 
377 430 2.364612 -1 -1 197 162 -1
218 
363 440 2.364612 -1 -1 183 160 -1
219 
343 456 2.366101 -1 -1 200 164 -1
220 
331 464 2.373547 -1 -1 191 158 -1
221 
323 468 2.383970 -1 -1 191 154 -1
222 
315 470 2.398861 -1 -1 210 151 -1
223 
169 522 2.431621 -1 597 232 145 207
224 
160 527 2.425664 -1 623 232 147 213
225 
118 548 2.455446 -1 552 228 142 213
226 
79 557 2.461402 751 478 255 139 221
227 
70 561 2.459913 -1 494 232 142 213
228 
62 561 2.467358 -1 478 237 142 221
229 
54 561 2.482249 -1 478 245 147 217
230 
48 561 2.497139 -1 462 224 151 207
231 
40 562 2.509052 -1 447 217 144 207
232 
31 564 2.512030 -1 421 213 140 217
233 
21 566 2.512030 -1 356 207 144 207
234 
15 567 2.520964 -1 386 194 142 221
235 
12 567 2.526921 -1 421 191 142 217
236 
12 567 2.526921 -1 408 183 142 213
237 
12 567 2.526921 -1 408 186 142 213
238 
12 567 2.526921 -1 408 191 142 207
239 
12 567 2.526921 -1 408 194 142 217
240 
12 567 2.526921 -1 408 173 142 213
241 
12 567 2.526921 -1 365 183 142 217
242 
11 567 2.525432 -1 408 183 144 203
243 
8 567 2.497140 -1 397 186 145 203
244 
4 567 2.436089 -1 375 197 147 210
245 
0 567 2.388439 478 356 224 147 173
246 
-27 591 2.395884 597 276 191 152 -1
247 
-34 595 2.398862 447 270 183 147 -1
248 
-40 600 2.395884 462 255 173 149 -1
249 
-41 601 2.388438 421 237 171 151 -1
250 
-48 604 2.389927 386 241 171 154 -1
251 
-54 607 2.392906 408 228 166 151 -1
252 
-55 607 2.401840 365 228 171 147 -1
253 
-56 608 2.400351 356 217 169 152 -1
254 
-58 610 2.398862 356 207 169 147 -1
255 
-67 618 2.395884 330 191 176 152 -1
256 
-68 619 2.388438 330 200 178 152 -1
257 
-69 620 2.382482 276 183 191 147 -1
258 
-70 621 2.378015 301 181 200 152 -1
259 
-71 622 2.370569 276 173 197 154 -1
260 
-73 623 2.369080 245 160 183 154 -1
261 
-75 624 2.376526 250 154 189 152 -1
262 
-79 627 2.375036 221 147 203 152 -1
263 
-79 627 2.370569 232 134 221 152 -1
264 
-79 627 2.385460 228 130 210 147 -1
265 
-79 627 2.489694 237 120 133 149 -1
266 
-79 627 2.529898 255 117 126 144 -1
267 
-79 627 2.620730 270 113 104 149 -1
268 
-79 627 2.660935 347 114 -1 151 -1
269 
-79 627 2.695183 434 114 -1 160 -1
270 
-79 627 2.805373 -1 110 -1 164 -1
271 
-80 627 2.867913 -1 112 -1 164 -1
272 
-82 627 2.933431 -1 129 -1 183 623
273 
-84 627 2.988526 -1 134 -1 181 681
274 
-84 627 3.037664 -1 145 -1 164 597
275 
-84 627 3.079358 -1 149 -1 307 574
276 
-84 627 3.147854 -1 176 -1 245 623
277 
-84 624 3.232730 -1 210 -1 191 -1
278 
-84 622 3.307183 -1 276 -1 152 -1
279 
-84 618 3.359299 -1 375 -1 144 -1
280 
-84 614 3.395037 -1 462 -1 140 -1
281 
-84 610 3.427796 -1 512 -1 131 -1
282 
-84 606 3.465022 -1 -1 -1 124 -1
283 
-84 602 3.514161 -1 -1 -1 122 -1
284 
-84 592 3.621373 -1 -1 118 107 -1
285 
-84 592 3.621373 -1 -1 122 105 -1
286 
-84 592 3.621373 -1 -1 122 106 -1
287 
-84 589 3.636264 623 -1 125 105 -1
288 
-85 585 3.682424 -1 -1 140 103 -1
289 
-95 571 3.718161 -1 -1 154 -1 -1
290 
-101 562 3.741986 -1 -1 164 -1 -1
291 
-105 554 3.789636 -1 -1 178 -1 -1
292 
-109 546 3.804527 -1 -1 191 -1 -1
293 
-115 537 3.798570 651 -1 197 -1 -1
294 
-121 528 3.804527 421 -1 194 -1 -1
295 
-125 520 3.820906 552 -1 224 -1 -1
296 
-130 513 3.826863 -1 -1 228 -1 751
297 
-141 496 3.826863 714 -1 241 103 -1
298 
-145 488 3.819417 -1 597 228 105 -1
299 
-149 480 3.817928 597 -1 250 106 -1
300 
-153 472 3.817928 356 -1 255 109 -1
301 
-157 464 3.807505 714 408 250 108 -1
302 
-193 417 3.753898 574 -1 228 120 -1
303 
-205 405 3.752409 681 -1 232 120 -1
304 
-209 401 3.733052 623 -1 228 124 -1
305 
-215 392 3.727095 330 -1 232 120 -1
306 
-236 366 3.689868 -1 -1 217 130 315
307 
-240 362 3.695825 -1 -1 210 124 330
308 
-245 357 3.697314 651 -1 221 129 330
309 
-259 343 3.698803 -1 -1 221 127 338
310 
-263 339 3.697314 -1 -1 224 129 315
311 
-271 331 3.703270 -1 -1 224 133 322
312 
-275 327 3.700292 -1 -1 224 129 294
313 
-279 323 3.685401 -1 -1 217 130 322
314 
-282 319 3.677956 552 -1 217 124 315
315 
-288 313 3.680934 -1 -1 221 134 322
316 
-291 308 3.679445 -1 -1 221 130 322
317 
-292 304 3.677956 -1 -1 221 133 288
318 
-301 296 3.676466 -1 -1 221 131 322
319 
-308 289 3.676466 552 -1 224 130 322
320 
-312 285 3.671999 -1 -1 224 131 322
321 
-318 279 3.669021 -1 -1 213 131 322
322 
-330 269 3.667531 -1 -1 221 131 315
323 
-348 253 3.663064 -1 -1 221 131 307
324 
-352 248 3.654130 -1 -1 221 133 307
325 
-352 244 3.633283 -1 -1 194 133 307
326 
-352 240 3.613925 623 -1 197 133 315
327 
-353 228 3.667531 -1 -1 221 129 315
328 
-354 224 3.677954 -1 -1 232 131 322
329 
-357 220 3.655618 365 -1 213 131 307
330 
-361 215 3.643706 -1 -1 210 133 307
331 
-375 204 3.651151 -1 -1 213 131 322
332 
-385 195 3.652640 651 -1 217 140 322
333 
-393 187 3.645195 -1 714 217 131 322
334 
-397 181 3.633282 -1 -1 221 133 322
335 
-402 174 3.624348 -1 -1 207 130 322
336 
-409 166 3.613925 -1 -1 210 133 307
337 
-417 158 3.612435 -1 -1 207 127 315
338 
-427 149 3.615414 -1 -1 210 134 288
339 
-444 131 3.631794 -1 -1 203 131 -1
340 
-454 122 3.627327 -1 -1 213 131 -1
341 
-458 116 3.618392 -1 -1 207 131 -1
342 
-464 110 3.613925 -1 -1 200 131 -1
343 
-480 100 3.616903 -1 -1 213 125 -1
344 
-490 92 3.619882 714 -1 213 131 -1
345 
-502 81 3.622860 -1 -1 207 130 -1
346 
-515 71 3.624349 -1 -1 213 131 -1
347 
-536 58 3.627327 -1 -1 221 125 -1
348 
-545 49 3.625838 -1 -1 221 127 -1
349 
-549 45 3.615414 -1 -1 213 130 -1
350 
-553 41 3.599035 -1 -1 203 127 -1
351 
-563 34 3.602013 -1 -1 197 131 -1
352 
-571 27 3.613925 -1 -1 210 127 -1
353 
-592 4 3.627326 -1 -1 221 125 -1
354 
-597 -1 3.622859 -1 -1 221 129 -1
355 
-606 -6 3.630305 -1 -1 232 130 -1
356 
-612 -10 3.645195 -1 -1 241 129 -1
357 
-619 -15 3.652641 -1 -1 237 129 -1
358 
-631 -21 3.643706 -1 -1 245 131 -1
359 
-635 -24 3.631794 -1 -1 245 133 -1
360 
-639 -27 3.625837 -1 -1 265 133 -1
361 
-653 -34 3.618392 -1 -1 -1 133 -1
362 
-661 -38 3.606479 -1 -1 -1 133 -1
363 
-669 -42 3.596056 -1 -1 -1 134 -1
364 
-678 -43 3.590100 -1 -1 -1 136 -1
365 
-692 -48 3.588610 -1 -1 -1 130 -1
366 
-703 -52 3.585632 -1 494 -1 133 -1
367 
-709 -53 3.573720 -1 -1 -1 133 -1
368 
-712 -53 3.551384 -1 -1 -1 137 -1
369 
-716 -53 3.545427 -1 -1 -1 131 -1
370 
-719 -54 3.546916 -1 -1 -1 137 -1
371 
-719 -54 3.535004 -1 -1 -1 136 -1
372 
-723 -54 3.557340 -1 -1 681 136 -1
373 
-729 -55 3.581165 -1 -1 -1 129 -1
374 
-737 -59 3.567763 -1 -1 -1 133 -1
375 
-745 -63 3.539471 -1 -1 -1 136 -1
376 
-756 -68 3.535004 -1 -1 -1 127 494
377 
-776 -72 3.548406 -1 -1 -1 129 -1
378 
-778 -72 3.554362 -1 -1 -1 129 -1
379 
-783 -72 3.551384 -1 -1 -1 129 -1
380 
-788 -73 3.548406 -1 -1 -1 127 -1
381 
-796 -75 3.545428 -1 -1 -1 131 -1
382 
-801 -76 3.552873 -1 681 -1 129 -1
383 
-832 -80 3.515646 -1 -1 -1 134 -1
384 
-833 -80 3.512668 -1 -1 -1 133 -1
385 
-833 -80 3.532026 -1 447 681 131 -1
386 
-833 -80 3.543938 -1 -1 623 139 -1
387 
-833 -80 3.543938 -1 -1 -1 137 -1
388 
-833 -80 3.543938 -1 -1 -1 140 -1
389 
-833 -80 3.543938 -1 -1 -1 144 -1
390 
-833 -80 3.543938 -1 -1 681 133 -1
391 
-833 -80 3.543938 -1 -1 -1 139 -1
392 
-833 -80 3.543938 -1 -1 -1 139 -1
393 
-833 -80 3.543938 -1 -1 -1 140 -1
trunk/code/projects/mapping/matlab/input_obstacle_1.txt
1 
5 0 0.376730 270 -1 552 270 -1
2 
5 0 0.376730 301 -1 447 270 -1
3 
4 0 0.360350 294 -1 494 260 -1
4 
4 0 0.340993 288 -1 494 265 -1
5 
4 0 0.291854 315 -1 447 270 -1
6 
1 0 0.212934 301 -1 462 270 -1
7 
0 0 -0.043183 288 -1 552 276 -1
8 
0 0 -0.089343 294 -1 651 270 -1
9 
14 0 -0.058073 265 -1 574 260 -1
10 
21 0 -0.072964 270 -1 478 260 -1
11 
30 0 -0.148905 270 -1 494 245 -1
12 
30 0 -0.287387 255 -1 512 265 -1
13 
25 1 -0.673051 294 -1 447 276 -1
14 
25 0 -0.743037 260 -1 462 276 -1
15 
30 -5 -0.717723 294 -1 462 260 -1
16 
38 -13 -0.714745 301 -1 447 276 -1
17 
44 -18 -0.713256 294 -1 434 270 -1
18 
53 -24 -0.726657 -1 -1 462 270 478
19 
53 -24 -0.726657 681 -1 462 265 421
20 
53 -24 -0.726657 -1 -1 447 270 421
21 
53 -24 -0.726657 -1 -1 397 270 408
22 
53 -24 -0.726657 434 -1 408 270 512
23 
53 -24 -0.726657 -1 -1 408 245 494
24 
53 -24 -0.726657 -1 -1 434 255 -1
25 
53 -24 -0.747504 -1 -1 478 270 315
26 
53 -24 -0.786219 -1 -1 462 270 228
27 
53 -24 -0.823445 -1 -1 421 260 228
28 
53 -24 -0.853226 -1 -1 397 270 224
29 
53 -24 -0.862161 -1 -1 365 270 217
30 
53 -24 -0.830891 -1 -1 397 270 232
31 
53 -24 -0.830891 -1 -1 512 265 228
32 
53 -24 -0.874073 -1 -1 462 245 228
33 
53 -25 -1.049781 -1 -1 408 260 213
34 
53 -25 -1.107854 -1 -1 375 265 221
35 
52 -24 -1.180818 -1 -1 397 276 217
36 
51 -23 -1.232935 -1 -1 375 260 221
37 
51 -23 -1.307387 -1 -1 408 265 217
38 
51 -23 -1.401198 -1 -1 386 260 217
39 
50 -22 -1.521811 -1 -1 365 241 217
40 
49 -19 -1.652847 -1 -1 386 265 224
41 
49 -12 -1.831533 -1 -1 365 245 210
42 
45 -14 -1.892584 -1 -1 375 250 224
43 
40 -22 -1.867271 -1 -1 397 338 221
44 
36 -26 -1.876205 -1 -1 347 434 210
45 
32 -30 -1.897051 -1 -1 375 512 210
46 
20 -39 -2.081694 -1 -1 397 245 224
47 
16 -39 -2.190394 -1 681 365 245 224
48 
11 -36 -2.528409 -1 714 365 250 232
49 
0 -41 -2.500117 -1 681 338 221 228
50 
-23 -59 -2.476292 -1 623 347 241 228
51 
-28 -63 -2.471825 -1 651 347 241 228
52 
-32 -65 -2.491182 -1 623 347 221 213
53 
-35 -65 -2.631153 -1 574 338 224 574
54 
-35 -65 -2.763678 -1 597 315 228 -1
55 
-28 -58 -3.101693 -1 494 288 241 -1
56 
-24 -56 -3.207416 -1 494 276 232 -1
57 
-17 -53 -3.356322 -1 478 232 224 -1
58 
-17 -49 -3.375679 -1 494 228 228 -1
59 
-17 -45 -3.395037 -1 478 221 232 -1
60 
-20 -41 -3.336964 714 494 224 228 -1
61 
-20 -37 -3.319096 -1 478 237 232 -1
62 
-20 -33 -3.293782 -1 447 338 228 -1
63 
-20 -29 -3.262512 -1 478 552 228 -1
64 
-20 -17 -3.228263 -1 478 408 237 408
65 
-5 -5 -3.582657 -1 447 347 260 447
66 
-2 -3 -3.654132 681 408 338 250 494
67 
-2 0 -3.676467 -1 408 338 276 386
68 
-5 2 -3.633285 623 408 301 276 421
69 
-6 2 -3.597548 -1 408 301 288 447
70 
-6 2 -3.466511 -1 478 307 315 347
71 
-8 2 -3.429285 -1 478 301 347 397
72 
-10 2 -3.415883 -1 512 294 338 375
73 
-11 2 -3.386102 -1 552 288 255 478
74 
0 0 -3.570745 -1 494 294 574 -1
75 
0 0 -3.677956 -1 386 294 386 -1
76 
0 0 -3.677956 -1 681 301 421 -1
77 
0 2 -3.864088 -1 -1 330 356 -1
78 
0 2 -3.840263 -1 -1 315 338 -1
79 
-5 6 -3.858131 -1 -1 365 330 -1
80 
-5 6 -3.878978 -1 -1 347 330 -1
81 
-5 6 -3.916204 -1 -1 356 338 -1
82 
-5 6 -3.968321 -1 -1 338 294 -1
83 
-5 6 -4.035328 -1 -1 338 322 -1
84 
-5 6 -4.127649 -1 -1 347 322 -1
85 
1 -1 -4.356964 -1 -1 347 307 -1
86 
0 0 -4.379299 -1 -1 330 307 -1
87 
0 0 -4.401635 -1 -1 365 307 -1
88 
-1 6 -4.358452 -1 -1 338 294 -1
89 
-2 11 -4.352496 -1 -1 347 294 -1
90 
-2 15 -4.349517 -1 -1 386 294 -1
91 
-2 21 -4.337605 -1 -1 408 288 -1
92 
-3 36 -4.428436 -1 -1 338 270 -1
93 
-3 36 -4.467151 -1 -1 347 270 -1
94 
-3 36 -4.496933 -1 -1 347 270 -1
95 
-3 36 -4.531181 -1 -1 347 270 -1
96 
-3 36 -4.596699 -1 714 338 260 -1
97 
-3 36 -4.681575 -1 -1 338 265 447
98 
-1 34 -4.767941 -1 -1 322 260 375
99 
2 25 -5.271239 -1 714 347 255 356
100 
5 39 -5.304000 -1 512 347 250 356
101 
5 42 -5.339737 -1 714 322 232 347
102 
5 42 -5.478219 -1 623 322 250 356
103 
5 42 -5.527358 -1 597 301 250 375
104 
4 41 -5.576496 -1 597 301 250 375
105 
2 39 -5.744759 -1 552 315 241 322
106 
0 34 -5.892174 -1 512 315 228 365
107 
0 34 -5.936845 651 494 315 241 356
108 
0 34 -5.936845 -1 462 301 241 330
109 
0 34 -5.936845 -1 512 307 241 356
110 
0 34 -5.936845 -1 512 301 228 356
111 
0 34 -5.936845 -1 478 315 241 330
112 
0 34 -5.936845 -1 494 301 241 356
113 
0 34 -5.936845 -1 512 301 241 347
114 
0 34 -5.936845 -1 494 315 241 365
115 
0 34 -5.936845 -1 512 301 241 356
116 
0 34 -5.936845 -1 494 294 241 375
117 
0 34 -5.936845 -1 494 301 241 356
118 
0 34 -5.936845 -1 478 288 224 356
119 
0 34 -5.936845 -1 447 315 241 365
120 
0 34 -5.936845 -1 494 315 241 347
121 
0 34 -5.936845 681 478 315 241 356
122 
0 34 -5.936845 -1 494 315 217 347
123 
0 34 -5.936845 -1 494 301 241 356
124 
0 34 -5.936845 -1 512 315 245 356
125 
0 34 -5.936845 -1 478 294 221 356
126 
0 34 -5.936845 -1 512 301 232 375
127 
0 34 -5.936845 -1 574 260 228 356
128 
0 34 -5.936845 -1 494 315 241 386
129 
0 34 -5.936845 -1 447 315 245 365
130 
0 34 -5.936845 -1 494 315 241 375
131 
0 34 -5.936845 -1 512 315 255 386
132 
0 34 -5.936845 -1 447 294 221 356
133 
0 34 -5.936845 -1 512 315 241 347
134 
0 34 -5.936845 -1 494 315 241 330
135 
0 34 -5.936845 -1 494 315 241 365
136 
0 34 -5.936845 -1 478 315 241 356
137 
0 34 -5.936845 -1 494 315 241 365
138 
0 34 -5.936845 -1 434 307 241 356
139 
2 35 -5.893663 -1 478 294 241 347
140 
2 35 -5.893663 -1 434 301 241 365
141 
2 35 -5.893663 -1 512 276 241 356
142 
2 35 -5.893663 -1 447 307 241 356
143 
2 35 -5.893663 -1 478 301 241 356
144 
2 35 -5.893663 -1 478 307 241 356
145 
2 35 -5.893663 -1 494 288 241 365
146 
2 35 -5.892174 -1 494 301 245 356
147 
2 35 -5.892174 751 447 301 237 356
148 
2 35 -5.892174 -1 494 307 232 356
149 
10 35 -5.722423 -1 552 228 241 447
150 
23 37 -5.756671 -1 462 228 250 375
151 
27 38 -5.753693 -1 434 260 232 397
152 
29 39 -5.767095 -1 421 315 245 386
153 
29 39 -5.796876 -1 421 386 250 386
154 
29 39 -5.826657 -1 397 434 250 397
155 
29 39 -5.854949 -1 434 386 232 397
156 
29 39 -5.905578 -1 434 478 241 397
157 
27 37 -5.933869 -1 397 408 245 397
158 
11 27 -6.228702 -1 408 315 270 478
159 
7 24 -6.329957 -1 408 294 276 447
160 
4 21 -6.413344 -1 447 288 288 447
161 
16 9 -6.303154 -1 408 260 330 623
162 
16 5 -6.300176 -1 478 260 330 512
163 
16 2 -6.301665 -1 447 260 322 751
164 
16 1 -6.306132 -1 462 260 338 714
165 
5 0 -6.648613 -1 714 237 408 -1
166 
9 -1 -6.636701 -1 714 221 597 -1
167 
11 -1 -6.623299 -1 -1 224 751 -1
168 
14 -1 -6.586072 -1 -1 228 681 -1
169 
18 -1 -6.533956 -1 -1 224 462 -1
170 
23 -1 -6.490773 -1 714 237 365 -1
171 
31 -1 -6.478860 -1 -1 228 356 -1
172 
33 -1 -6.492262 -1 -1 232 347 -1
173 
35 -1 -6.527999 -1 -1 217 338 -1
174 
35 -1 -6.648612 681 -1 224 294 -1
175 
33 0 -6.706685 -1 -1 221 288 -1
176 
30 0 -6.764758 -1 -1 217 276 -1
177 
27 0 -6.839210 -1 -1 217 270 -1
178 
25 0 -6.907706 408 -1 224 265 -1
179 
21 0 -6.979180 -1 -1 221 260 -1
180 
9 0 -7.163823 -1 -1 232 250 -1
181 
6 0 -7.245720 -1 -1 232 241 -1
182 
6 0 -7.268056 -1 -1 237 237 -1
183 
10 -5 -7.239765 -1 -1 232 228 -1
184 
13 -9 -7.265079 -1 -1 237 228 -1
185 
14 -14 -7.300816 -1 -1 213 217 -1
186 
14 -17 -7.323151 -1 -1 217 221 -1
187 
15 -19 -7.338041 -1 -1 217 207 -1
188 
15 -19 -7.349955 -1 -1 224 213 -1
189 
15 -19 -7.360378 -1 623 232 207 -1
190 
14 -18 -7.367824 714 -1 245 203 -1
191 
14 -18 -7.367824 597 -1 232 203 -1
192 
13 -17 -7.388670 512 -1 232 203 -1
193 
13 -18 -7.443765 623 -1 213 210 -1
194 
6 -8 -7.771357 -1 -1 221 191 -1
195 
6 -8 -7.807094 -1 -1 232 191 -1
196 
6 -17 -7.768378 -1 -1 232 186 -1
197 
6 -25 -7.741575 -1 -1 224 186 -1
198 
6 -33 -7.711794 228 -1 241 169 -1
199 
6 -41 -7.710305 478 -1 245 176 -1
200 
6 -47 -7.757955 597 -1 250 176 -1
201 
6 -51 -7.838363 365 -1 250 171 -1
202 
0 -52 -8.006625 307 -1 241 171 228
203 
0 -48 -8.079589 232 -1 232 173 228
204 
0 -35 -8.404202 255 -1 301 158 237
205 
-3 -32 -8.602244 386 -1 301 169 221
206 
-17 -49 -8.660317 -1 -1 294 176 224
207 
-21 -53 -8.721369 714 -1 294 164 224
208 
-23 -53 -8.822624 -1 -1 301 166 221
209 
-23 -53 -8.989398 -1 -1 294 171 224
210 
-52 -51 -9.165106 494 -1 -1 181 250
211 
-57 -49 -9.369104 751 -1 -1 191 237
212 
-54 -46 -9.422709 -1 -1 -1 197 237
213 
-50 -45 -9.482271 -1 -1 -1 197 241
214 
-48 -43 -9.555234 -1 -1 -1 197 217
215 
-51 -24 -10.001951 -1 -1 -1 228 217
216 
-55 -20 -10.021310 347 -1 -1 232 217
217 
-55 -16 -10.057047 -1 -1 -1 241 217
218 
-55 -12 -10.119588 -1 -1 -1 250 217
219 
-55 -10 -10.214888 -1 -1 -1 255 221
220 
-51 -10 -10.339968 478 -1 -1 270 194
221 
-47 -10 -10.485894 -1 623 -1 276 207
222 
-50 -1 -10.484405 -1 -1 -1 288 183
223 
-54 5 -10.471003 356 -1 -1 288 194
224 
-58 11 -10.454623 -1 -1 -1 322 186
225 
-59 15 -10.439733 -1 -1 -1 294 200
226 
-62 27 -10.481426 -1 -1 -1 356 250
227 
-62 27 -10.521631 -1 -1 -1 347 265
228 
-62 27 -10.555879 597 -1 -1 347 260
229 
-59 24 -10.645222 -1 -1 -1 408 276
230 
-55 20 -10.703294 478 -1 -1 447 288
231 
-52 16 -10.758389 -1 -1 -1 512 270
232 
-52 16 -10.758389 -1 -1 -1 -1 276
233 
-52 16 -10.758389 714 -1 -1 -1 270
234 
-52 16 -10.758389 -1 -1 -1 -1 260
235 
-52 16 -10.758389 375 -1 -1 -1 255
236 
-47 2 -10.975790 -1 -1 -1 -1 245
237 
-44 0 -11.042797 -1 -1 -1 -1 255
238 
-40 0 -11.077044 -1 -1 -1 -1 265
239 
-36 5 -11.026417 -1 -1 -1 -1 270
240 
-32 8 -11.005569 -1 -1 -1 574 265
241 
-29 15 -10.984720 -1 -1 -1 -1 294
242 
-27 15 -11.013013 -1 -1 -1 -1 301
243 
-25 15 -11.024925 -1 -1 -1 -1 315
244 
-25 15 -11.024925 -1 -1 -1 -1 375
245 
-25 13 -11.050240 -1 -1 -1 -1 494
246 
-25 13 -11.050240 -1 -1 -1 -1 -1
247 
-25 13 -11.050240 -1 -1 -1 -1 -1
248 
-24 11 -11.094911 -1 -1 -1 -1 -1
249 
-12 30 -11.111291 -1 -1 -1 -1 -1
250 
-8 32 -11.093422 -1 -1 -1 -1 -1
251 
0 33 -11.188722 -1 -1 -1 -1 -1
252 
0 33 -11.228926 -1 -1 -1 -1 -1
253 
0 33 -11.275085 -1 -1 -1 -1 -1
254 
0 33 -11.355494 -1 -1 -1 -1 -1
255 
0 30 -11.440371 -1 714 -1 -1 -1
256 
0 21 -11.839438 -1 714 -1 -1 315
257 
16 22 -12.204256 -1 338 -1 -1 294
258 
14 20 -12.327847 -1 597 -1 -1 301
259 
8 15 -12.594387 -1 623 -1 -1 301
trunk/code/projects/mapping/matlab/input_obstacle_2.txt
1 
30 0 0.324613 -1 -1 512 200 -1
2 
30 0 0.324613 -1 -1 462 197 -1
3 
30 0 0.324613 -1 -1 478 200 -1
4 
30 0 0.324613 -1 -1 574 203 -1
5 
30 0 0.324613 -1 -1 478 203 -1
6 
30 0 0.324613 -1 -1 512 203 -1
7 
30 0 0.324613 -1 -1 494 203 -1
8 
30 0 0.324613 -1 -1 434 200 -1
9 
30 0 0.324613 -1 -1 447 203 -1
10 
30 0 0.323124 -1 -1 478 203 -1
11 
30 0 0.230803 681 -1 375 203 -1
12 
30 0 0.259095 -1 -1 386 210 -1
13 
33 0 0.323124 -1 -1 478 203 -1
14 
33 0 0.367796 -1 -1 597 207 -1
15 
33 0 0.388642 -1 -1 681 210 -1
16 
34 0 0.366307 -1 -1 574 207 -1
17 
38 0 0.351416 -1 -1 651 210 -1
18 
46 2 0.351416 -1 -1 494 213 -1
19 
51 2 0.352905 -1 -1 552 197 -1
20 
57 2 0.348438 -1 -1 597 213 -1
21 
68 4 0.354394 -1 -1 597 203 -1
22 
80 6 0.354394 -1 -1 651 221 -1
23 
94 10 0.351416 -1 -1 574 213 -1
24 
103 12 0.345460 -1 -1 512 228 -1
25 
107 12 0.329080 -1 -1 574 221 -1
26 
111 12 0.309722 574 -1 552 221 -1
27 
134 15 0.294832 338 -1 447 228 -1
28 
144 16 0.288876 307 -1 574 224 -1
29 
172 20 0.266540 276 -1 478 237 -1
30 
180 20 0.242715 241 -1 447 221 -1
31 
186 20 0.238248 478 -1 478 232 -1
32 
202 20 0.215912 -1 -1 408 241 -1
33 
208 20 0.204000 -1 -1 397 241 -1
34 
212 20 0.196554 597 -1 375 245 -1
35 
222 21 0.193576 -1 -1 434 250 -1
36 
234 22 0.196554 -1 -1 462 228 -1
37 
238 22 0.195065 -1 -1 375 245 -1
38 
246 22 0.192087 -1 -1 434 250 -1
39 
252 22 0.190598 -1 -1 397 245 -1
40 
262 23 0.186131 -1 -1 421 241 -1
41 
269 23 0.178686 -1 -1 386 237 -1
42 
283 24 0.180175 -1 -1 408 250 -1
43 
293 24 0.181664 -1 -1 408 288 -1
44 
301 24 0.171240 -1 -1 421 375 -1
45 
308 24 0.162306 -1 -1 408 386 -1
46 
329 24 0.135503 -1 -1 356 237 -1
47 
364 24 0.122102 -1 -1 375 232 -1
48 
398 24 0.163795 -1 623 386 232 245
49 
414 24 0.171240 -1 714 365 237 224
50 
427 24 0.187620 -1 552 315 232 221
51 
435 24 0.198043 -1 552 315 241 217
52 
445 24 0.224846 -1 623 237 241 217
53 
449 24 0.251649 -1 623 260 232 224
54 
453 24 0.285897 681 597 315 221 228
55 
455 24 0.330569 -1 623 -1 245 237
56 
459 24 0.363328 -1 597 751 250 250
57 
462 24 0.415445 -1 623 574 232 260
58 
466 24 0.488408 623 681 478 265 301
59 
468 24 0.559883 -1 623 434 265 386
60 
470 25 0.668584 -1 714 434 322 -1
61 
474 29 0.686452 -1 623 434 347 -1
62 
478 32 0.719211 -1 681 397 330 -1
63 
480 32 0.753460 -1 751 397 386 -1
64 
480 32 0.792175 -1 -1 408 397 -1
65 
481 34 0.820467 -1 -1 386 365 -1
66 
486 39 0.856204 -1 -1 397 421 -1
67 
496 51 0.988730 -1 751 365 322 -1
68 
496 53 1.060204 -1 447 375 -1 -1
69 
502 73 1.136145 -1 494 397 512 -1
70 
502 94 1.238889 -1 -1 408 478 -1
71 
502 99 1.261225 -1 -1 397 421 -1
72 
502 102 1.262714 -1 -1 365 462 -1
73 
502 104 1.270159 -1 -1 408 408 -1
74 
502 104 1.283561 -1 -1 397 434 -1
75 
502 104 1.291006 -1 -1 434 462 -1
76 
502 104 1.292495 -1 -1 434 462 -1
77 
502 104 1.292495 -1 -1 375 447 -1
78 
502 104 1.325254 -1 -1 421 397 -1
79 
502 108 1.389283 -1 -1 597 434 -1
80 
502 120 1.460757 -1 -1 478 397 -1
81 
502 133 1.499472 -1 -1 512 356 -1
82 
502 147 1.505429 -1 -1 421 397 -1
83 
502 152 1.511385 -1 -1 462 408 -1
84 
502 185 1.542655 -1 -1 322 408 -1
85 
489 245 1.579881 -1 681 512 347 237
86 
485 246 1.590304 -1 623 651 408 260
87 
481 251 1.596260 -1 681 -1 397 260
88 
477 258 1.596260 -1 714 -1 397 245
89 
473 264 1.597749 -1 651 -1 408 245
90 
469 269 1.608173 -1 651 -1 408 241
91 
457 287 1.618596 -1 574 751 386 228
92 
453 288 1.634975 -1 552 681 421 232
93 
451 288 1.633486 -1 623 681 421 237
94 
451 288 1.633486 -1 574 597 421 250
95 
451 288 1.633486 -1 574 623 408 224
96 
451 288 1.633486 -1 597 597 421 228
97 
451 288 1.633486 -1 552 623 375 237
98 
450 288 1.631997 -1 623 574 397 228
99 
450 288 1.631997 -1 552 623 397 228
100 
450 288 1.631997 -1 552 681 408 232
101 
447 288 1.649866 -1 552 574 421 237
102 
443 290 1.704961 -1 494 512 434 260
103 
439 292 1.760056 -1 574 447 408 245
104 
435 292 1.812173 -1 512 447 397 301
105 
431 292 1.858333 -1 681 421 447 356
106 
419 301 1.841954 -1 574 408 512 301
107 
399 302 1.897049 408 386 574 32375 6400
108 
391 309 1.876202 751 -1 397 386 -1
109 
387 310 1.891093 -1 -1 408 -1 -1
110 
383 311 1.917895 -1 -1 365 -1 -1
111 
375 313 1.932786 -1 -1 386 -1 -1
112 
371 315 1.941720 -1 -1 347 -1 -1
113 
367 316 1.958099 -1 -1 397 751 -1
114 
363 317 1.970012 -1 -1 386 681 -1
115 
359 320 1.975968 -1 -1 421 597 -1
116 
346 333 1.956610 -1 -1 397 623 751
117 
342 336 1.952143 681 -1 375 623 375
118 
330 343 1.971501 -1 -1 408 552 330
119 
325 348 1.970012 -1 -1 365 512 301
120 
308 368 1.981924 -1 375 397 494 245
121 
299 380 1.980435 -1 -1 386 447 241
122 
290 394 1.978946 -1 -1 397 462 228
123 
274 414 1.992347 330 681 397 386 217
124 
269 418 2.005749 -1 -1 397 434 221
125 
265 419 2.017662 -1 -1 408 421 224
126 
261 422 2.023618 -1 -1 397 447 228
127 
255 429 2.025107 -1 -1 408 421 224
128 
251 433 2.016173 -1 -1 434 421 213
129 
244 441 2.011706 -1 -1 408 408 217
130 
239 446 2.016173 -1 -1 408 408 217
131 
231 457 2.017662 -1 -1 478 408 213
132 
226 462 2.008728 -1 -1 434 408 330
133 
222 464 1.998304 -1 -1 408 408 552
134 
217 467 1.999793 -1 -1 434 397 651
135 
205 473 1.986392 -1 -1 552 356 494
136 
201 475 1.987881 -1 -1 512 386 322
137 
197 479 1.989370 -1 -1 478 386 356
138 
179 500 1.974480 -1 -1 651 386 365
139 
175 501 1.961078 -1 -1 597 330 408
140 
171 501 1.952144 -1 -1 751 356 597
141 
167 502 1.956611 -1 -1 651 386 574
142 
155 507 1.992348 623 -1 -1 408 651
143 
142 519 1.964056 -1 -1 -1 408 -1
144 
130 519 1.874714 -1 -1 597 434 714
145 
126 519 1.850889 -1 -1 -1 462 714
146 
121 519 1.833021 -1 -1 -1 494 714
147 
121 519 1.833021 -1 -1 -1 478 681
148 
121 519 1.833021 -1 -1 -1 462 552
149 
121 519 1.833021 623 -1 -1 512 260
150 
121 519 1.833021 -1 -1 -1 512 265
151 
121 519 1.833021 751 -1 -1 597 301
152 
121 519 1.833021 -1 -1 -1 574 301
153 
121 519 1.833021 -1 -1 -1 597 347
154 
121 519 1.833021 -1 -1 -1 574 338
155 
121 519 1.833021 -1 -1 -1 574 315
156 
121 519 1.833021 -1 -1 -1 651 347
157 
121 519 1.833021 -1 -1 -1 651 365
158 
121 519 1.833021 -1 -1 -1 -1 365
159 
121 519 1.833021 -1 -1 -1 651 338
160 
121 519 1.833021 -1 -1 -1 651 338
161 
121 519 1.833021 751 -1 -1 512 338
162 
118 518 1.871736 -1 -1 -1 714 434
163 
118 518 1.871736 -1 -1 -1 751 478
164 
117 518 1.873225 -1 -1 -1 714 408
165 
110 522 1.965546 -1 -1 -1 -1 -1
166 
106 526 1.990860 681 -1 -1 -1 -1
167 
100 534 1.993838 -1 751 -1 -1 -1
168 
84 547 2.111473 -1 -1 -1 -1 -1
169 
80 551 2.133809 -1 -1 -1 -1 -1
170 
76 555 2.156145 -1 -1 -1 -1 -1
171 
72 559 2.193371 -1 -1 -1 -1 -1
172 
67 563 2.224641 -1 -1 -1 -1 -1
173 
60 567 2.239532 -1 681 -1 -1 -1
174 
50 573 2.251444 -1 623 -1 -1 -1
175 
34 584 2.325897 -1 494 -1 -1 -1
176 
30 585 2.348233 -1 512 -1 -1 -1
177 
20 585 2.379503 -1 478 -1 -1 -1
178 
15 585 2.398861 -1 494 -1 -1 -1
179 
2 585 2.431620 -1 494 -1 -1 -1
180 
-16 590 2.488206 -1 375 -1 -1 -1
181 
-17 591 2.477782 -1 386 -1 -1 -1
182 
-17 591 2.458425 651 307 751 -1 -1
183 
-17 591 2.458425 -1 375 597 -1 -1
184 
-17 591 2.458425 -1 397 -1 -1 -1
trunk/code/projects/mapping/matlab/input_none_0.txt
1 
0 0 0.000000 -1 -1 681 597 -1
2 
0 0 0.000000 -1 -1 751 681 -1
3 
0 0 0.000000 -1 -1 751 651 -1
4 
0 0 0.000000 -1 -1 651 597 -1
5 
0 0 0.000000 -1 -1 714 681 -1
6 
0 0 0.000000 -1 -1 -1 651 -1
7 
0 0 0.000000 -1 -1 -1 597 -1
8 
0 0 0.000000 -1 -1 751 651 -1
9 
0 0 0.000000 -1 -1 651 651 -1
10 
0 0 0.000000 -1 -1 714 651 -1
11 
0 0 0.000000 -1 -1 -1 597 -1
12 
0 0 0.000000 -1 -1 681 597 -1
13 
0 0 0.000000 -1 -1 681 651 140
14 
-23 0 -0.370774 -1 -1 -1 574 147
15 
-13 0 -0.358861 -1 -1 -1 714 164
16 
48 -8 -0.373752 -1 -1 751 623 173
17 
54 -9 -0.370774 -1 -1 681 597 173
18 
95 -19 -0.376730 -1 -1 -1 574 145
19 
125 -25 -0.388642 -1 -1 751 597 160
20 
133 -25 -0.391620 -1 -1 681 651 160
21 
185 -36 -0.413956 -1 -1 714 552 142
22 
193 -36 -0.424380 -1 -1 651 494 105
23 
217 -42 -0.449694 -1 -1 651 421 -1
24 
225 -46 -0.452672 -1 -1 597 347 -1
25 
261 -62 -0.469051 -1 -1 597 338 -1
26 
268 -65 -0.473518 -1 -1 574 338 -1
27 
288 -73 -0.470540 -1 -1 512 356 -1
28 
301 -79 -0.470540 -1 -1 552 338 -1
29 
312 -84 -0.476496 -1 -1 597 356 -1
30 
323 -90 -0.469051 -1 -1 494 356 -1
31 
367 -109 -0.458628 651 -1 651 347 -1
32 
388 -118 -0.457139 -1 -1 597 347 -1
33 
401 -124 -0.449693 -1 -1 681 338 -1
34 
409 -128 -0.439270 -1 -1 597 347 -1
35 
432 -139 -0.430336 -1 -1 681 375 -1
36 
440 -143 -0.412467 -1 -1 623 356 -1
37 
450 -147 -0.396088 -1 -1 574 365 -1
38 
459 -151 -0.388642 -1 -1 478 330 -1
39 
470 -156 -0.391620 -1 -1 494 330 -1
40 
481 -161 -0.396088 -1 -1 478 375 -1
41 
520 -178 -0.412467 -1 -1 434 330 -1
42 
528 -181 -0.403533 -1 -1 365 330 -1
43 
542 -182 -0.375241 681 -1 307 347 -1
44 
567 -182 -0.297810 -1 -1 597 365 -1
45 
590 -182 -0.196555 -1 -1 651 386 -1
46 
650 -179 0.034248 -1 -1 494 512 -1
47 
658 -175 0.086365 -1 -1 447 512 -1
48 
682 -163 0.214423 -1 681 434 386 -1
49 
690 -159 0.257606 -1 623 365 347 -1
50 
712 -147 0.382686 -1 494 408 -1 -1
51 
716 -143 0.410978 -1 -1 375 681 -1
52 
728 -131 0.558394 -1 -1 421 574 -1
53 
732 -125 0.597110 -1 -1 574 512 -1
54 
734 -121 0.631358 -1 751 408 552 -1
55 
734 -120 0.638803 -1 681 434 512 -1
56 
734 -120 0.638803 -1 -1 462 552 -1
57 
734 -118 0.635825 -1 -1 421 552 -1
58 
734 -118 0.635825 -1 -1 421 512 -1
59 
734 -114 0.652204 -1 -1 447 478 -1
60 
741 -102 0.698365 -1 -1 478 434 -1
61 
752 -84 0.753460 -1 681 408 478 -1
62 
756 -76 0.787708 -1 714 478 462 -1
63 
760 -68 0.820467 -1 751 408 434 -1
64 
764 -60 0.838336 -1 714 338 421 -1
65 
758 89 1.831531 -1 -1 397 512 -1
66 
754 93 1.856845 -1 -1 421 512 -1
67 
742 115 1.983414 -1 -1 462 397 -1
68 
736 123 2.023618 -1 -1 478 375 -1
69 
712 147 2.111473 -1 -1 597 365 -1
70 
688 166 2.229108 -1 -1 -1 365 -1
71 
679 172 2.235065 -1 -1 -1 330 -1
72 
650 198 2.257401 347 -1 -1 375 -1
73 
642 206 2.264846 -1 -1 -1 338 -1
74 
630 218 2.263357 -1 -1 -1 375 -1
75 
604 243 2.248467 -1 -1 -1 397 -1
76 
584 263 2.248467 -1 -1 -1 386 -1
77 
558 293 2.246978 -1 -1 -1 356 -1
78 
544 307 2.254423 751 -1 -1 386 -1
79 
518 333 2.263357 330 -1 -1 386 -1
80 
479 364 2.293139 -1 -1 -1 408 -1
81 
440 390 2.348234 -1 -1 -1 434 -1
82 
410 407 2.398862 -1 -1 -1 421 -1
83 
402 411 2.422687 -1 -1 -1 447 -1
84 
374 423 2.477783 -1 -1 -1 462 -1
85 
338 439 2.559681 -1 -1 -1 623 -1
86 
329 443 2.592440 -1 -1 -1 574 -1
87 
321 447 2.619243 -1 -1 -1 651 -1
88 
297 448 2.733900 478 -1 -1 -1 -1
89 
289 448 2.763681 -1 -1 623 -1 -1
90 
281 448 2.794951 -1 -1 462 -1 -1
91 
249 448 2.924499 -1 -1 -1 -1 -1
92 
237 448 2.949813 -1 -1 -1 597 -1
93 
225 448 2.969171 -1 -1 681 -1 -1
94 
213 448 2.987040 -1 -1 -1 -1 -1
95 
198 448 3.009376 -1 -1 -1 -1 -1
96 
198 448 3.009376 -1 -1 -1 -1 -1
97 
198 448 3.009376 -1 -1 -1 -1 -1
98 
198 448 3.009376 -1 -1 -1 -1 -1
99 
198 448 3.009376 -1 -1 -1 -1 -1
100 
198 448 3.009376 -1 -1 -1 -1 -1
101 
198 448 3.009376 -1 -1 -1 -1 -1
102 
192 448 3.045113 -1 623 -1 -1 -1
103 
187 448 3.057025 -1 -1 -1 -1 -1
104 
154 448 3.116588 -1 -1 -1 -1 -1
105 
142 447 3.153814 -1 -1 -1 -1 -1
106 
130 443 3.192529 -1 -1 -1 -1 -1
107 
120 439 3.228266 -1 -1 -1 -1 -1
108 
112 435 3.269960 -1 -1 -1 -1 -1
109 
70 415 3.535011 -1 -1 -1 -1 -1
110 
58 410 3.582661 -1 494 -1 -1 -1
111 
50 406 3.613931 -1 574 -1 -1 -1
112 
42 401 3.649668 -1 478 -1 -1 -1
113 
34 393 3.685405 -1 462 714 -1 -1
114 
-11 336 4.029377 -1 714 221 -1 -1
115 
-11 333 4.050223 213 -1 -1 32295 6400
116 
-11 333 4.050223 -1 -1 260 -1 -1
117 
-11 333 4.050223 -1 681 260 -1 -1
118 
-11 312 4.188705 -1 -1 338 -1 -1
119 
-13 302 4.197639 -1 -1 365 -1 -1
120 
-14 274 4.272092 -1 -1 347 -1 -1
121 
-17 262 4.298895 -1 -1 347 -1 -1
122 
-17 248 4.324209 -1 -1 347 -1 -1
123 
-17 240 4.337611 -1 -1 338 -1 -1
124 
-17 232 4.353991 -1 -1 338 -1 -1
125 
-17 224 4.376327 -1 -1 338 -1 -1
126 
-17 216 4.407597 -1 552 338 -1 -1
127 
-17 208 4.443335 -1 -1 347 -1 -1
128 
-17 199 4.465670 -1 -1 338 -1 -1
129 
-17 188 4.489495 -1 338 347 -1 -1
130 
-17 176 4.516298 -1 -1 356 651 -1
131 
-17 164 4.555013 -1 -1 338 260 -1
132 
-17 152 4.592239 -1 -1 322 315 -1
133 
-17 142 4.623510 -1 -1 397 347 -1
134 
-17 134 4.645845 -1 -1 397 330 -1
135 
-17 126 4.669671 -1 -1 386 330 -1
136 
-17 120 4.671160 -1 -1 408 330 -1
137 
-13 108 4.727744 -1 -1 434 330 -1
138 
-13 108 4.727744 -1 -1 421 322 -1
139 
-13 108 4.727744 -1 -1 434 330 -1
140 
-13 108 4.727744 -1 -1 462 330 -1
141 
-11 106 4.732211 -1 -1 434 307 -1
142 
-5 96 4.820065 -1 -1 651 330 -1
143 
0 50 4.952590 -1 -1 478 330 -1
144 
0 34 4.930254 -1 -1 434 330 -1
145 
0 -156 4.690515 -1 -1 478 330 -1
146 
0 -170 4.684558 -1 -1 478 338 -1
147 
0 -198 4.633930 -1 714 462 347 -1
148 
0 -206 4.622017 -1 714 434 347 -1
149 
0 -218 4.608615 -1 574 434 315 -1
150 
0 -274 4.498425 512 597 347 347 -1
151 
0 -282 4.483534 597 597 322 347 -1
152 
-1 -292 4.476089 651 512 338 338 -1
153 
-2 -314 4.488002 574 478 338 330 -1
154 
-2 -318 4.514805 512 447 315 322 -1
155 
-2 -323 4.572878 574 462 322 294 -1
156 
-2 -329 4.645842 623 397 255 288 -1
157 
-1 -333 4.748587 681 421 237 301 -1
158 
0 -24159 -0.000000 25601 15105 -255 -9473 126
159 
0 -24159 -0.000000 23297 13057 -255 16383 126
160 
0 -353 5.108937 408 434 301 294 -1
161 
0 -357 5.183390 -1 421 315 356 -1
162 
0 -361 5.254864 -1 494 301 365 -1
163 
0 -363 5.323359 -1 494 315 386 -1
164 
0 -364 5.388877 -1 597 294 347 -1
165 
0 -364 5.454395 -1 681 288 276 -1
166 
1 -365 5.524380 -1 512 301 270 -1
167 
22 -381 5.735826 -1 494 315 375 -1
168 
33 -381 5.881753 -1 -1 315 347 -1
169 
36 -381 5.947271 -1 -1 365 365 -1
170 
36 -381 5.997899 -1 -1 421 338 -1
171 
39 -381 6.047037 -1 -1 512 330 -1
172 
43 -381 6.103621 -1 -1 478 330 -1
173 
47 -381 6.140847 -1 -1 512 330 -1
174 
51 -381 6.182540 -1 -1 421 330 -1
175 
55 -381 6.206365 -1 -1 365 330 -1
176 
59 -381 6.239125 -1 -1 338 330 -1
177 
63 -381 6.251038 -1 -1 322 330 -1
178 
68 -381 6.243592 -1 -1 270 330 -1
179 
73 -381 6.243592 -1 -1 301 338 -1
180 
83 -381 6.239124 -1 -1 315 347 -1
181 
88 -381 6.243592 -1 -1 322 347 -1
182 
100 -381 6.237635 -1 -1 330 347 -1
183 
123 -381 6.210831 -1 -1 288 356 -1
184 
131 -381 6.209342 -1 -1 301 338 -1
185 
143 -381 6.210831 -1 -1 322 356 -1
186 
147 -381 6.198918 -1 -1 315 356 -1
187 
162 -381 6.152757 -1 751 301 356 -1
188 
167 -381 6.125954 -1 714 301 375 -1
189 
171 -381 6.108085 -1 651 276 386 -1
190 
175 -381 6.082771 -1 714 276 386 -1
191 
179 -381 6.044055 -1 681 301 375 -1
192 
183 -381 6.005340 -1 574 347 365 -1
193 
188 -381 5.977047 -1 623 365 375 -1
194 
206 -381 5.866858 -1 462 356 397 -1
195 
210 -381 5.828142 597 512 347 386 -1
196 
214 -381 5.802828 597 552 347 356 -1
197 
235 -381 5.636055 447 512 294 421 -1
198 
235 -381 5.597340 462 623 276 447 -1
199 
235 -381 5.589895 462 623 245 447 -1
200 
235 -381 5.582449 462 574 270 434 -1
201 
235 -381 5.575004 462 714 255 447 -1
202 
235 -381 5.575004 421 681 270 447 -1
203 
235 -381 5.575004 462 681 250 447 -1
204 
235 -381 5.575004 447 623 224 434 -1
205 
235 -381 5.575004 434 552 265 447 -1
206 
235 -381 5.575004 447 681 270 421 -1
207 
235 -381 5.575004 421 651 265 386 -1
208 
235 -381 5.575004 397 651 265 434 -1
209 
235 -381 5.575004 421 651 245 447 -1
210 
235 -381 5.575004 447 623 265 434 -1
211 
235 -381 5.575004 462 597 255 478 -1
212 
235 -381 5.575004 478 681 265 447 -1
213 
235 -381 5.575004 408 597 255 434 -1
214 
235 -381 5.575004 462 623 241 447 -1
215 
235 -381 5.575004 408 681 265 447 -1
216 
235 -381 5.575004 462 623 255 447 -1
217 
235 -381 5.575004 421 651 265 421 -1
218 
235 -381 5.575004 356 681 265 447 -1
219 
235 -381 5.575004 462 681 245 434 -1
220 
235 -381 5.548200 421 651 260 397 -1
221 
235 -381 5.522886 397 751 255 462 -1
222 
236 -381 5.573514 421 751 245 434 -1
223 
240 -385 5.650945 421 421 265 386 -1
224 
244 -387 5.738799 434 356 250 322 -1
225 
253 -387 5.972579 574 330 221 294 -1
226 
256 -387 6.039587 574 347 294 294 -1
227 
256 -387 6.088726 -1 338 552 288 -1
228 
256 -387 6.088726 512 347 512 294 -1
229 
256 -387 6.088726 -1 347 574 288 -1
230 
262 -387 6.239120 -1 347 315 276 -1
231 
274 -378 6.459500 -1 375 270 307 -1
232 
278 -374 6.545865 512 397 260 330 -1
233 
290 -362 6.806448 -1 552 260 322 -1
234 
294 -358 6.889834 -1 -1 260 751 -1
235 
296 -354 6.953863 -1 -1 270 447 -1
236 
300 -346 6.998535 -1 -1 288 330 -1
237 
304 -338 7.040227 -1 -1 276 356 -1
238 
308 -330 7.075965 -1 -1 276 330 -1
239 
312 -322 7.105747 -1 -1 301 315 -1
240 
316 -313 7.135528 -1 -1 294 315 -1
241 
321 -301 7.160842 -1 714 315 288 -1
242 
325 -290 7.177222 -1 -1 315 276 -1
243 
347 -250 7.211471 -1 -1 322 260 -1
244 
356 -235 7.220406 -1 -1 365 245 -1
245 
360 -223 7.233807 714 -1 347 255 -1
246 
364 -211 7.265077 -1 -1 375 255 -1
247 
368 -199 7.303792 -1 -1 434 255 -1
248 
372 -189 7.336552 574 -1 408 255 -1
249 
372 -185 7.341020 -1 -1 434 250 -1
250 
372 -184 7.336553 -1 -1 478 255 -1
251 
372 -184 7.336553 -1 -1 447 250 -1
252 
372 -184 7.336553 -1 -1 421 245 -1
253 
372 -183 7.333574 -1 -1 421 255 -1
254 
372 -182 7.345487 -1 -1 434 245 -1
255 
372 -178 7.376757 -1 -1 597 250 -1
256 
372 -173 7.430363 -1 -1 597 245 -1
257 
372 -167 7.478013 -1 -1 -1 255 -1
258 
372 -163 7.533108 -1 -1 -1 255 -1
259 
372 -156 7.595648 -1 -1 751 265 -1
260 
372 -149 7.661166 -1 -1 -1 255 -1
261 
372 -142 7.723705 -1 -1 -1 276 -1
262 
372 -136 7.781778 -1 -1 -1 276 -1
263 
372 -128 7.804114 -1 -1 -1 307 -1
264 
372 -119 7.798157 -1 -1 -1 322 -1
265 
372 -104 7.801136 -1 -1 -1 307 -1
266 
372 -92 7.783267 -1 -1 -1 330 -1
267 
372 -80 7.759442 -1 -1 -1 330 -1
268 
372 -65 7.749019 -1 -1 -1 356 -1
269 
372 -26 7.668610 -1 -1 -1 375 -1
270 
372 -14 7.655208 -1 -1 -1 386 -1
271 
372 -2 7.637340 -1 -1 -1 386 -1
272 
372 22 7.603091 447 -1 574 375 -1
273 
372 30 7.591178 -1 -1 -1 408 -1
274 
372 54 7.537572 512 -1 -1 421 -1
275 
372 62 7.521193 -1 -1 751 421 -1
276 
372 70 7.498857 552 -1 751 408 -1
277 
372 78 7.482478 -1 -1 -1 434 -1
278 
373 88 7.473543 -1 -1 681 447 -1
279 
373 96 7.452696 751 -1 -1 434 -1
280 
376 104 7.427382 -1 -1 -1 434 -1
281 
376 111 7.415470 -1 -1 -1 462 -1
282 
376 115 7.384199 552 -1 -1 434 -1
283 
376 119 7.352929 -1 -1 651 462 -1
284 
379 133 7.312724 -1 -1 -1 434 -1
285 
383 139 7.300812 -1 -1 -1 478 -1
286 
387 146 7.290388 -1 -1 -1 408 -1
287 
395 160 7.300812 -1 -1 -1 421 -1
288 
400 170 7.299323 -1 -1 -1 478 -1
289 
409 185 7.300812 -1 -1 -1 462 -1
290 
413 193 7.332082 494 -1 -1 494 -1
291 
417 201 7.373775 -1 -1 -1 462 -1
292 
421 209 7.415468 -1 -1 -1 462 -1
293 
425 217 7.446738 -1 574 -1 494 -1
294 
429 225 7.485454 462 -1 -1 462 -1
295 
432 233 7.518214 -1 -1 651 512 -1
296 
432 241 7.555440 -1 -1 -1 552 -1
297 
432 249 7.595644 -1 -1 -1 574 -1
298 
432 257 7.632870 -1 -1 -1 574 -1
299 
432 263 7.674564 -1 -1 -1 623 -1
300 
432 270 7.708812 623 -1 -1 751 -1
301 
432 286 7.807090 681 -1 -1 -1 -1
302 
431 294 7.868141 -1 -1 -1 -1 -1
303 
419 317 8.039382 -1 -1 -1 714 -1
304 
415 319 8.081075 -1 -1 -1 -1 -1
305 
414 319 8.085542 -1 -1 -1 -1 -1
306 
414 319 8.085542 -1 -1 -1 -1 -1
307 
412 319 8.081075 -1 -1 -1 -1 -1
trunk/code/projects/mapping/matlab/input_none_1.txt
1 
13 0 -1.246336 -1 -1 574 338 623
2 
13 0 -1.246336 -1 -1 714 375 552
3 
13 0 -1.246336 -1 -1 751 330 597
4 
13 0 -1.246336 -1 -1 751 356 494
5 
13 0 -1.264204 -1 -1 651 338 597
6 
13 0 -1.307387 -1 -1 751 330 478
7 
13 0 -1.338657 -1 -1 681 338 512
8 
13 0 -1.360992 -1 -1 714 338 681
9 
13 -6 -1.423532 -1 -1 -1 338 -1
10 
13 -10 -1.457780 -1 -1 -1 347 -1
11 
0 -44 -1.646888 -1 751 301 338 -1
12 
0 -50 -1.642421 -1 623 330 330 -1
13 
0 -60 -1.630509 651 651 462 338 -1
14 
0 -64 -1.602217 -1 714 651 330 -1
15 
0 -68 -1.576903 -1 651 -1 365 -1
16 
0 -79 -1.503940 -1 714 574 375 -1
17 
0 -79 -1.495006 -1 597 574 375 -1
18 
0 -79 -1.492028 -1 623 447 365 -1
19 
0 -79 -1.486072 -1 681 512 356 -1
20 
0 -86 -1.454802 -1 623 447 375 -1
21 
0 -87 -1.390773 -1 681 447 397 -1
22 
0 -87 -1.383328 -1 597 386 397 -1
23 
0 -87 -1.377372 -1 623 397 397 -1
24 
0 -87 -1.390773 -1 623 434 386 -1
25 
0 -89 -1.390773 -1 494 447 397 -1
26 
0 -92 -1.392262 -1 623 447 421 -1
27 
0 -97 -1.398218 -1 494 434 408 -1
28 
0 -102 -1.393751 -1 552 447 434 -1
29 
0 -107 -1.390773 -1 512 408 421 -1
30 
0 -110 -1.392262 -1 597 421 421 -1
31 
0 -114 -1.386306 -1 494 375 421 -1
32 
0 -119 -1.381839 -1 512 421 434 -1
33 
0 -127 -1.360992 -1 447 397 447 -1
34 
0 -127 -1.350569 -1 462 386 397 -1
35 
0 -134 -1.292496 -1 552 365 478 -1
36 
0 -138 -1.268672 -1 494 365 494 -1
37 
0 -142 -1.240380 -1 552 330 478 -1
38 
0 -146 -1.213577 -1 574 338 512 -1
39 
0 -150 -1.200176 -1 552 315 478 -1
40 
0 -151 -1.085519 -1 -1 338 301 512
41 
0 -151 -1.036381 -1 651 307 447 -1
42 
0 -151 -1.021490 -1 651 294 512 -1
43 
0 -151 -0.941081 -1 623 294 -1 -1
44 
0 -151 -0.917257 -1 623 307 714 -1
45 
0 -151 -0.894921 -1 494 315 623 -1
46 
0 -151 -0.877052 -1 512 315 574 -1
47 
0 -152 -0.851738 -1 512 315 552 -1
48 
0 -154 -0.832381 -1 462 307 512 -1
49 
2 -156 -0.833870 -1 447 301 462 -1
50 
5 -160 -0.827913 -1 356 301 512 -1
51 
6 -161 -0.821957 -1 434 301 478 -1
52 
7 -163 -0.818979 -1 408 294 462 -1
53 
10 -166 -0.814512 -1 408 294 434 -1
54 
12 -168 -0.808556 -1 307 276 462 -1
55 
12 -168 -0.805578 -1 375 270 462 -1
56 
13 -169 -0.775797 -1 356 276 421 -1
57 
13 -169 -0.768352 -1 356 265 421 -1
58 
13 -169 -0.762396 -1 434 270 408 -1
59 
14 -170 -0.738571 -1 651 276 386 -1
60 
14 -170 -0.728148 -1 714 265 386 -1
61 
14 -170 -0.719213 -1 -1 288 375 -1
62 
14 -170 -0.701345 -1 -1 276 356 -1
63 
14 -170 -0.679009 -1 -1 294 356 -1
64 
14 -170 -0.659651 -1 -1 276 347 -1
65 
14 -170 -0.635826 -1 -1 322 347 -1
66 
14 -170 -0.609023 -1 -1 276 330 -1
67 
14 -170 -0.573286 -1 -1 294 307 -1
... This diff was truncated because it exceeds the maximum size that can be displayed.

Also available in: Unified diff