ground_thruth.log

利用极坐标系统对机器人所携带的激光传感器所测得的数据进行匹配

307
313
319
327
335
345
354
361
372
383
393
404
419
433
446
463
506
528
555
556
559
581
602
621
630
636
640
646
628
618
608
609
616
609
612
611
601
606
606
601
605
599
596
599
596
583
589
580
574
562
574
559
559
552
553
540
544
533
537
526
531
518
520
505
509
495
519
498
512
499
507
494
496
492
510
501
502
493
493
481
469
457
444
438
439
440
429
419
409
401
393
385
377
371
364
358
352
345
339
334
329
324
319
314
309
304
301
296
293
290
285
281
278
274
270
267
265
265
266
268
270
271
273
275
277
279
281
284
285
283
280
277
276
273
271
268
266
264
261
259
257
256
253
252
250
248
246
244
242
241
240
238
236
235
235
232
230
228
228
227
226
224
223
223
221
220
220
219
218
215
215
213
212
212
212
211
210
208
208
208
207
206
205
204
203
203
202
202
202
201
201
200
199
199
199
198
198
197
197
196
196
196
195
194
195
194
194
193
193
192
192
192
192
191
192
191
193
192
192
192
192
192
191
190
190
190
192
192
192
193
193
191
192
192
191
191
192
192
193
193
194
32796
32797
32796
32795
32795
32795
32795
32794
29 0 0 1.5708
152
152
153
152
152
153
153
153
153
153
153
153
154
155
154
154
153
155
155
154
154
154
155
155
155
156
156
156
157
158
158
159
160
159
160
160
162
160
162
163
162
162
163
163
164
165
166
167
167
168
167
168
168
170
170
171
172
172
173
175
176
177
176
177
178
179
180
181
182
184
185
186
187
187
188
189
190
191
194
195
196
198
199
201
202
203
204
206
208
210
211
213
215
217
220
223
236
236
240
242
244
248
250
251
254
257
259
263
265
269
272
274
278
281
284
288
291
290
290
292
294
298
303
308
312
317
322
328
333
338
344
351
358
364
371
379
386
395
403
411
420
428
436
444
449
448
458
459
462
461
461
461
463
458
460
464
465
466
473
471
467
464
461
458
457
452
453
449
447
445
445
444
443
442
441
441
441
440
438
436
439
436
435
434
435
434
434
432
432
431
430
428
431
425
430
428
428
426
430
430
431
431
432
430
431
430
432
433
434
432
433
429
425
425
428
417
405
393
382
372
364
355
346
337
329
321
316
308
303
297
290
286
280
275
269
265
261
256
253
247
245
243
245
246
248
250
250
252
253
254
255
256
258
259
262
259
256
254
251
249
246
243
240
238
235
234
230
228
226
224
221
220
218
216
213
212
210
209
206
204
203
202
201
200
198
197
195
193
192
190
190
187
187
187
186
184
183
183
181
180
180
178
177
176
175
175
174
173
172
171
170
169
169
168
168
167
167
166
166
165
164
164
164
163
162
161
162
161
160
160
160
159
159
158
158
157
157
156
156
155
155
155
155
155
155
155
154
154
154
153
153
153
153
153
153
153
153
153
154
152
153
30 0 0 1.5708
115
116
116
116
116
116
117
117
118
118
119
119
119
120
119
120
120
121
121
122
122
123
123
124
123
125
125
126
126
128
128
128
129
129
130
130
130
131
132
133
133
134
136
136
137
137
137
139
139
141
142
143
143
144
146
146
148
149
150
151
152
153
154
156
157
158
160
162
162
164
165
166
168
170
172
174
175
177
179
181
183
185
187
189
191
195
202
213
216
218
220
222
226
229
233
235
238
243
248
251
254
258
263
269
269
269
270
270
272
279
285
291
298
303
311
317
324
332
341
350
358
368
377
388
401
414
426
441
453
475
519
544
556
556
572
595
617
635
647
652
660
640
637
636
624
630
625
625
621
616
613
618
32763
613
612
610
610
607
604
598
599
591
583
586
582
575
577
567
566
557
562
557
551
548
542
540
534
525
522
525
529
524
524
520
512
508
503
517
514
521
510
500
487
475
463
450
441
437
439
435
424
414
405
397
389
382
374
367
360
354
348
342
337
331
326
322
316
312
306
302
298
294
291
287
282
280
277
272
270
266
263
265
267
269
270
273
273
276
278
281
282
284
284
282
279
276
274
272
270
268
266
263
261
259
257
254
253
251
249
247
245
244
242
241
239
237
235
234
233
232
230
229
227
226
225
223
222
221
221
219
218
217
216
215
214
213
212
211
210
209
209
208
208
207
206
204
205
204
203
203
202
202
202
201
201
199
199
199
198
198
198
197
196
196
196
195
194
195
193
194
193
193
193
192
192
191
191
192
192
192
193
193
192
192
193
192
191
190
191
191
191
192
192
192
192
192
193
193
193
193
191
192
192
193
193
193
193
194
194
194
195
31 0 0 1.5708
154
153
153
153
153
152
152
152
151
151
151
150
151
150
150
149
150
149
150
150
148
150
150
151
150
151
150
150
149
150
149
150
150
150
149
149
150
150
151
150
150
148
150
149
150
151
150
151
150
151
152
152
151
152
152
153
153
153
153
153
154
154
154
155
155
156
156
157
157
157
159
159
160
159
160
161
162
163
162
164
163
165
165
167
167
168
167
168
169
170
171
172
173
176
176
179
187
188
188
190
191
192
193
195
197
197
198
200
200
202
203
204
206
208
210
211
212
214
217
218
219
221
224
226
227
229
233
234
235
233
233
234
236
238
240
243
245
248
251
254
257
259
263
266
269
274
278
282
285
291
293
299
303
308
313
318
323
329
335
341
347
353
360
366
375
381
389
398
408
416
445
32763
466
480
497
502
502
511
526
542
559
575
595
615
644
646
677
705
734
758
766
746
754
749
755
749
754
752
760
748
748
748
746
738
741
740
743
742
742
744
740
741
742
751
744
608
757
599
603
598
597
567
584
585
575
592
587
582
570
586
583
573
564
559
479
558
553
556
550
476
446
431
417
404
392
381
371
364
365
366
358
350
342
334
326
319
313
306
301
295
289
284
279
273
270
264
259
256
253
248
244
240
237
233
230
226
224
221
218
216
213
210
207
204
202
200
198
196
193
191
189
190
191
193
194
196
198
200
201
203
204
206
207
210
212
212
212
210
208
207
205
204
203
201
200
198
196
195
194
193
191
190
188
188
187
185
185
184
183
182
181
180
179
177
176
176
175
175
175
173
171
172
171
171
168
169
168
168
168
166
167
165
165
165
164
163
162
163
163
162
162
32 0 0 1.5708
114
114
114
114
115
115
115
115
117
116
117
117
118
117
118
118
119
119
120
120
121
120
121
122
122
122
122
123
124
125
125
126
126
126
128
128
129
130
130
131
131
132
133
134
135
136
137
137
137
138
139
141
141
142
143
144
145
146
148
159
160
160
161
163
165
167
168
169
171
173
173
175
176
178
180
181
183
185
186
189
191
192
194
196
199
201
203
205
207
211
213
212
212
212
213
215
217
220
224
226
231
234
239
242
246
250
255
260
264
269
274
280
285
291
298
304
311
318
326
333
341
350
359
369
379
390
402
441
457
473
492
492
494
512
530
547
552
564
563
570
563
574
563
559
553
553
545
548
540
541
515
516
525
511
503
506
498
489
487
474
469
464
457
447
444
436
438
433
426
416
407
402
398
393
393
390
389
388
385
385
386
383
382
382
379
380
377
380
377
378
375
374
375
375
372
374
372
372
371
372
372
373
371
373
370
373
373
374
364
363
358
353
346
342
336
330
325
321
315
310
306
301
298
293
290
286
282
279
275
271
269
265
262
259
256
254
251
248
246
243
241
238
235
234
232
229
227
225
223
221
219
217
216
216
218
220
222
224
226
228
231
233
235
239
241
241
239
238
236
235
234
232
231
229
228
227
225
224
223
222
221
219
219
218
217
216
215
214
213
212
212
210
210
208
208
207
207
205
205
204
204
204
203
202
202
201
201
200
200
199
199
199
198
198
197
196
196
195
196
195
195
195
194
194
193
193
193
192
193
193
193
193
193
193
193
194
194
191
191
192
191
191
194
193
193
193
193
194
193
193
193
192
193
193
193
194
194
194
194
195
195
33 0 0 1.5708
105
105
107
107
105
105
104
104
104
105
105
105
105
105
106
105
107
107
106
106
107
107
108
108
109
108
108
110
109
110
110
111
111
111
112
112
112
113
113
114
114
113
114
115
114
116
116
117
117
118
118
119
119
120
120
121
122
123
122
124
124
125
126
126
127
128
128
130
130
131
131
132
133
134
135
136
138
139
139
140
142
143
144
145
146
148
148
151
152
154
154
156
157
159
160
162
164
165
167
169
171
173
176
177
179
181
183
186
188
190
193
196
199
202
204
207
211
214
217
221
224
228
232
235
241
244
249
255
260
265
270
277
283
288
295
302
310
320
350
377
386
394
400
399
410
410
416
410
411
409
412
408
411
408
417
413
412
409
413
410
413
409
412
408
412
407
410
404
411
402
408
402
407
400
405
399
403
399
405
398
406
400
407
402
411
405
414
408
416
411
419
412
422
414
424
425
417
407
393
379
364
349
335
322
312
302
291
282
274
266
257
251
244
238
231
225
220
215
211
205
202
196
193
189
185
181
177
174
171
168
166
163
161
158
154
153
151
148
147
144
142
141
138
136
135
133
130
130
128
127
125
124
122
120
119
118
116
115
114
113
112
112
110
109
109
107
106
105
104
103
102
101
100
99
99
98
98
98
97
96
95
94
94
93
93
92
92
91
90
90
89
88
88
87
87
87
87
87
86
85
84
84
85
83
83
83
81
82
82
81
80
81
81
81
80
79
79
79
79
79
78
79
79
78
79
78
78
77
77
77
76
76
76
77
76
76
76
76
75
75
75
75
75
75
75
75
74
75
74
75
74
75
75
75
75
74
74
74
74
75
74
34 0 0 1.5708
68
68
67
68
68
67
69
69
69
69
70
70
69
70
70
71
72
71
71
71
72
72
73
73
74
74
74
74
75
75
76
77
77
77
77
78
79
78
78
79
80
80
80
81
82
82
83
84
84
85
87
87
87
88
88
89
90
90
91
92
92
94
94
95
96
97
98
98
99
100
101
102
104
105
107
108
109
110
111
112
114
116
117
119
121
122
124
126
128
129
131
133
135
137
140
142
144
147
150
152
155
158
161
165
168
171
175
179
183
187
191
197
200
206
211
217
224
229
237
244
252
261
270
280
291
306
350
366
380
397
424
450
459
461
471
511
548
510
490
494
508
484
508
479
492
477
487
471
479
460
468
454
459
446
453
442
449
437
443
432
437
426
433
424
428
421
426
419
426
421
429
424
429
426
430
426
432
425
432
423
423
415
412
404
394
383
373
364
355
346
337
330
323
316
309
302
296
291
285
280
273
269
264
259
254
250
245
241
238
235
231
226
223
221
218
215
212
208
205
203
200
197
196
193
192
189
186
184
182
181
179
178
176
174
172
170
169
166
166
164
162
161
160
158
157
156
155
153
152
151
150
148
147
145
145
145
143
142
141
140
140
139
138
137
136
135
134
133
134
133
132
132
130
131
129
129
128
128
128
127
126
125
125
125
125
123
123
123
122
122
121
121
121
120
120
119
119
119
118
118
118
117
117
117
117
116
116
116
115
115
115
116
116
116
116
115
115
114
115
115
113
114
114
115
113
113
114
114
114
114
114
114
112
114
113
114
114
114
114
114
114
114
114
114
113
114
115
115
115
116
115
116
116
116
116
116
116
115
116
117
117
35 0 0 1.5708
107
106
106
106
105
105
105
104
104
104
104
104
103
105
104
105
106
106
105
106
105
106
105
105
104
104
105
106
106
106
106
105
106
103
103
104
104
104
105
105
106
106
106
107
106
106
107
107
107
107
108
107
108
108
108
109
109
110
110
111
111
111
111
111
112
112
113
114
114
114
115
115
115
115
115
117
117
117
117
119
119
120
120
121
122
123
124
125
124
125
126
127
127
128
129
130
131
131
132
132
133
135
136
137
138
139
140
141
143
143
144
145
146
147
149
151
152
155
156
157
158
159
161
163
164
166
168
170
171
173
176
178
179
182
185
187
190
192
195
197
200
203
205
209
212
215
219
221
226
230
235
238
243
247
251
258
280
285
290
296
302
309
317
324
332
341
348
359
369
379
391
403
406
406
412
427
442
492
515
537
543
552
578
586
616
651
690
32767
32763
32767
32763
939
32763
32763
32763
938
32763
32763
32763
32763
32763
930
939
935
2000
32765
32763
32763
32763
916
32763
916
32763
908
821
818
32767
32763
32763
32763
528
32763
468
465
465
465
457
370
357
343
330
318
307
298
288
280
272
263
255
249
243
237
231
226
219
214
210
205
202
197
192
189
185
181
177
175
172
169
166
163
160
157
154
153
150
148
145
144
142
139
137
136
134
131
131
129
127
125
125
123
122
120
119
117
117
114
114
114
112
111
110
109
108
107
106
105
104
103
102
101
100
99
99
99
98
97
97
96
95
94
94
93
93
93
92
91
90
90
89
89
88
88
88
87
87
86
85
85
85
84
83
83
82
81
81
81
81
80
80
80
80
79
79
79
79
78
78
78
79
78
78
77
77
77
77
76
77
76
76
76
76
36 0 0 1.5708
70
69
70
70
71
72
71
71
72
72
73
73
73
73
73
73
73
73
74
75
75
76
76
76
76
76
77
77
77
78
78
79
79
79
79
80
81
80
81
82
82
83
84
84
85
86
86
87
88
87
88
88
90
90
90
92
92
93
94
95
96
97
97
98
99
99
100
101
102
103
104
106
107
108
110
111
112
113
114
115
117
119
121
122
123
125
126
129
130
132
134
136
138
141
143
145
148
150
152
154
158
161
163
167
170
174
178
182
185
190
195
198
203
209
214
219
226
231
238
257
279
289
297
307
318
334
343
361
380
392
396
397
406
429
517
534
535
569
580
633
686
32763
838
890
32763
32763
882
32763
32763
872
873
871
32763
866
865
862
857
851
850
846
844
841
836
838
831
828
803
803
799
755
697
662
629
602
575
553
529
509
487
471
471
471
472
463
450
393
379
368
358
350
340
332
324
317
309
302
297
291
285
280
274
269
264
259
254
250
245
243
238
235
230
227
222
220
217
214
211
208
206
202
199
197
194
192
190
187
185
183
181
178
178
175
173
171
169
168
166
165
163
162
161
159
157
156
156
154
153
152
150
148
147
146
146
145
143
142
141
140
139
138
137
137
136
134
134
133
133
133
132
131
130
129
128
128
127
127
126
125
125
125
125
124
123
122
122
121
121
120
120
119
119
118
119
118
117
117
117
116
116
115
115
115
115
116
115
115
114
115
114
114
114
114
113
113
113
112
113
112
112
111
111
111
111
110
111
111
111
113
112
112
111
112
111
111
111
110
111
112
112
111
111
110
111
111
111
112
112
112
112
113
113
112
113
113
113
114
114
114
115
114
115
37 0 0 1.5708
4101
4100
4101
32767
2479
32763
2035
32763
32763
32767
32763
871
864
855
850
32767
714
715
703
673
676
32763
32763
494
475
456
438
424
411
397
384
372
361
351
340
331
322
314
307
300
292
285
279
273
267
262
257
251
246
242
237
233
229
226
222
218
214
210
207
205
202
198
195
193
190
188
185
182
180
178
176
174
171
170
168
166
164
162
161
159
157
156
154
153
152
149
148
147
146
145
143
141
142
141
140
140
139
140
140
141
142
147
177
146
145
145
144
150
152
157
161
165
170
174
181
185
191
196
202
210
217
226
231
424
380
439
400
455
463
449
435
445
443
336
317
445
452
459
359
370
488
418
492
492
654
678
696
696
694
689