ground_thruth.log

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

691
654
647
689
688
668
685
685
684
684
683
682
681
612
594
280
281
280
280
280
280
279
279
279
279
279
279
279
279
279
279
279
279
280
280
280
280
280
279
261
261
261
262
260
245
242
232
219
213
188
182
183
174
172
170
168
166
163
161
160
158
157
153
154
151
149
148
146
145
143
142
140
138
138
136
134
133
132
132
130
129
128
126
127
129
130
139
127
124
123
122
122
121
121
121
122
123
123
124
125
125
125
126
127
128
128
129
131
131
132
133
134
135
137
138
139
140
141
142
144
145
145
147
150
161
162
164
166
168
169
171
172
174
176
178
180
182
185
187
189
192
195
197
200
202
205
208
211
215
218
221
224
228
227
228
227
231
239
242
247
252
256
262
264
267
267
269
273
279
286
292
298
306
314
325
333
341
351
362
379
400
414
428
443
462
479
499
522
545
569
598
620
662
705
747
806
855
913
1005
1162
1176
32763
3248
32767
32767
3244
32767
1673
1673
1672
1673
38 0 0 1.5708
430
416
401
386
375
364
353
342
334
324
315
308
301
293
285
279
273
267
261
256
251
245
241
236
232
228
223
220
217
213
209
206
203
199
196
193
192
189
186
183
181
178
176
174
171
170
168
166
164
161
160
158
157
155
154
153
151
149
147
146
146
143
141
141
140
139
137
136
134
134
133
132
132
130
129
128
127
126
126
125
125
123
122
121
120
119
120
118
118
117
117
117
116
115
116
115
115
114
116
114
117
116
118
127
137
124
123
124
123
128
140
153
169
188
211
427
425
423
423
430
439
304
311
384
355
344
443
680
684
675
682
681
679
615
679
678
656
677
677
676
676
675
674
675
674
596
588
587
587
587
586
585
482
450
358
278
276
276
276
276
277
276
277
277
278
278
278
278
279
279
280
281
281
281
281
281
282
283
282
275
265
265
266
267
266
263
251
250
240
233
226
220
215
210
205
200
196
189
190
190
191
183
182
180
179
178
177
175
174
172
170
170
169
167
165
165
164
162
160
160
159
158
158
156
156
155
154
153
152
151
150
149
149
147
146
146
147
150
159
149
147
145
145
144
145
144
146
147
143
147
148
150
152
154
155
156
158
160
162
163
166
168
170
171
173
177
181
195
197
199
202
205
209
211
215
218
222
225
229
233
237
240
245
250
254
260
263
262
262
267
277
283
288
296
299
306
305
311
319
328
337
346
359
368
380
393
407
422
442
459
476
498
521
545
573
32763
32763
32763
32763
32767
32763
32763
952
1047
1202
32763
3286
3287
3286
3285
6020
1711
1708
1710
1708
1711
1712
1713
1713
1714
1558
32763
1210
1062
953
863
790
729
676
632
595
558
531
531
520
446
435
414
396
382
370
39 0 0 1.5708
621
645
669
700
732
32763
829
831
892
934
938
32767
1132
32767
32767
1431
32767
1732
1879
2190
618
605
605
605
4100
4100
4100
4098
32763
2033
847
673
671
704
676
501
449
402
363
336
307
287
267
252
235
222
211
202
191
184
175
168
162
157
151
145
142
136
132
128
123
121
117
114
111
109
106
102
102
100
99
98
97
97
97
97
97
97
99
101
101
102
103
119
102
100
100
98
100
100
101
102
103
104
105
106
107
109
111
111
112
113
115
116
118
120
121
122
125
125
128
129
130
133
134
137
139
140
142
146
148
149
153
155
158
161
165
168
171
187
230
229
329
337
342
346
350
355
360
365
368
318
342
376
359
340
391
398
400
388
256
265
381
380
378
379
384
294
299
338
406
367
355
646
428
428
428
646
578
638
637
635
634
632
625
629
557
597
625
624
604
621
622
621
619
618
618
617
617
214
214
214
213
213
213
212
225
217
216
216
212
212
212
212
212
212
212
212
212
212
213
213
213
212
213
213
213
214
214
223
248
197
195
195
195
196
196
196
194
181
182
168
165
158
152
148
142
139
133
124
119
118
119
119
120
111
110
109
107
106
105
104
104
102
102
100
99
98
98
97
97
96
95
94
94
92
92
93
91
90
89
89
89
88
87
87
86
86
86
85
84
84
83
83
82
81
80
80
80
79
80
80
79
79
78
78
78
77
77
76
76
75
76
75
75
75
74
74
74
75
75
75
77
86
85
79
78
78
77
76
75
74
74
74
73
73
74
74
74
75
76
76
77
78
78
79
80
82
85
85
87
89
91
94
95
96
99
101
104
106
109
114
125
143
148
152
157
163
167
174
181
40 0 0 1.5708
160
155
150
145
138
136
131
127
124
120
117
114
110
108
105
103
100
97
96
94
92
89
89
86
84
83
82
80
78
76
76
75
74
72
70
70
69
69
69
68
66
65
65
66
65
64
65
65
65
65
66
66
67
67
69
70
70
75
98
95
74
70
70
69
69
68
69
69
71
72
74
75
75
77
78
81
82
83
86
88
89
92
94
95
97
100
102
106
108
112
115
118
121
126
130
135
139
144
150
153
349
301
317
367
323
339
383
372
364
358
366
365
363
361
240
263
377
384
330
280
280
343
349
414
414
624
622
621
619
619
618
618
544
616
614
609
611
613
611
611
611
610
610
610
610
610
524
523
523
522
522
523
523
450
415
382
282
213
210
210
211
211
211
211
212
216
216
213
212
212
213
213
214
214
214
214
214
215
216
216
217
217
217
218
219
219
220
250
251
252
203
202
203
203
204
205
205
206
206
190
190
191
191
183
169
166
163
159
157
155
152
149
148
144
143
140
138
136
135
132
133
133
135
136
136
137
127
126
125
125
124
123
123
122
122
121
121
120
119
118
118
117
116
117
116
116
115
115
114
114
114
114
113
112
112
112
111
112
110
109
110
110
109
109
109
108
108
107
107
106
107
107
105
105
106
107
106
106
106
106
106
106
105
106
105
106
115
110
110
109
108
107
106
106
107
106
107
108
109
112
113
116
120
122
126
130
134
138
143
160
186
194
203
216
226
239
242
243
243
254
278
283
288
290
305
331
367
431
507
572
661
825
979
1311
32767
32767
32767
1967
1710
1711
1713
1713
1715
1715
1716
1718
1714
1540
1433
1310
1216
1126
1060
997
941
881
869
840
773
736
709
41 0 0 1.5708
166
170
174
178
181
186
190
195
200
204
209
216
220
226
232
239
247
256
255
256
246
243
239
236
232
229
225
226
228
229
230
232
232
234
236
238
239
240
242
261
246
237
237
238
238
239
239
239
239
239
205
195
195
214
241
240
240
106
93
92
92
92
93
98
96
265
264
270
269
265
264
259
261
258
263
223
219
219
217
217
221
233
273
277
276
275
246
229
224
217
214
208
205
201
197
192
189
186
181
180
176
174
172
173
174
175
176
177
178
178
181
181
182
183
184
184
185
186
188
189
191
192
193
194
196
198
199
201
201
204
206
205
203
205
180
176
183
210
212
214
216
218
220
222
224
226
230
231
222
204
206
215
213
212
210
208
206
206
206
204
153
153
191
214
217
220
222
225
228
186
180
186
239
243
408
311
289
316
254
253
254
450
447
445
442
404
413
434
433
453
454
454
455
454
445
452
451
449
375
449
449
447
446
446
424
445
444
444
305
346
442
442
441
441
354
410
440
439
355
353
353
353
353
352
352
352
352
311
301
352
251
265
287
215
214
352
353
353
354
354
354
115
114
108
102
97
93
89
84
80
32763
32763
32763
70
32763
32763
63
62
63
63
32763
32767
32767
32767
32767
32767
32767
32767
46
44
45
44
44
44
44
45
45
45
46
46
46
46
46
47
46
47
47
47
48
48
48
48
49
49
50
50
50
50
52
55
56
57
58
59
60
61
64
84
57
56
55
54
55
56
56
56
57
58
58
59
60
60
61
61
61
62
62
63
64
65
66
67
67
68
69
69
70
71
72
73
75
76
76
78
79
80
82
85
112
112
112
112
111
111
111
110
109
109
109
108
108
42 0 0 1.5708
198
194
192
189
186
186
187
188
190
192
193
194
196
197
198
199
201
203
204
218
224
200
201
201
201
201
201
202
202
203
203
203
203
204
188
161
159
159
168
206
206
206
207
208
207
219
230
234
234
230
232
239
234
232
232
225
228
227
227
228
230
233
62
62
61
60
60
60
60
60
60
61
63
62
247
203
200
198
194
191
188
185
182
180
177
175
172
169
167
166
163
161
159
158
155
154
152
151
150
149
150
152
152
153
155
156
158
159
160
161
162
164
166
168
168
170
171
173
175
177
178
181
183
183
186
189
191
190
188
190
191
194
197
177
163
164
206
210
213
216
219
222
224
210
209
196
195
206
205
204
203
202
201
199
199
201
203
206
209
213
217
220
224
162
150
151
241
292
443
178
178
253
253
438
456
457
460
459
449
457
457
456
455
454
381
453
453
453
445
444
452
451
451
451
450
450
319
324
450
451
380
373
451
452
371
365
366
366
366
366
367
367
367
367
367
327
313
353
369
369
289
263
268
371
372
233
231
235
374
376
286
283
333
325
326
327
327
328
329
330
331
268
235
235
268
140
137
32763
32763
127
126
126
125
121
32763
32763
32763
32763
32763
32763
32763
107
32763
32763
32763
32763
32763
32763
32763
32763
32763
32763
91
90
90
90
89
89
32763
32763
32763
32763
32763
82
32763
32763
32763
32763
77
76
77
76
77
77
78
79
80
81
81
82
83
84
85
88
87
93
92
90
91
91
93
94
95
97
99
100
101
103
103
105
107
109
110
112
114
116
118
120
127
151
150
148
148
147
147
147
147
146
146
145
145
145
140
119
116
116
115
119
123
126
130
134
139
141
135
136
136
137
137
137
136
43 0 0 1.5708
80
81
80
81
82
98
224
228
230
234
236
240
243
247
251
253
251
236
227
219
219
219
219
220
221
221
222
222
223
223
224
225
226
227
228
245
222
221
213
176
174
176
199
219
218
218
218
218
217
217
216
216
215
215
215
215
214
214
234
236
238
241
234
233
236
239
234
232
237
238
210
183
183
184
183
184
183
191
232
232
239
235
232
234
238
229
178
165
154
142
135
128
127
127
128
128
128
128
129
129
129
129
130
130
130
129
130
129
130
130
131
131
131
132
133
133
134
134
134
135
136
136
137
137
138
138
139
139
140
141
141
142
143
144
144
145
146
149
118
115
116
128
145
146
146
147
148
149
150
151
153
153
154
155
156
157
159
159
160
161
163
165
166
155
141
140
154
152
151
149
148
146
145
143
109
88
89
89
92
142
144
144
145
146
148
149
151
152
154
156
158
159
131
114
114
113
167
171
173
175
182
342
259
221
224
221
348
186
185
187
383
381
379
376
375
334
370
371
367
389
388
387
390
389
388
380
386
385
384
384
310
347
383
382
381
381
378
362
379
379
379
378
378
379
244
243
378
378
378
378
304
293
379
378
378
295
291
291
291
291
291
291
292
292
293
292
293
293
293
238
244
278
294
295
295
247
190
189
234
297
299
299
300
197
158
157
160
302
303
301
212
205
219
189
212
217
251
256
257
258
259
261
261
261
262
235
187
164
165
215
269
270
272
272
274
275
277
279
281
282
284
284
286
288
290
292
302
300
296
293
71
69
70
68
68
32763
32763
32763
32763
32763
32763
32763
32763
32763
32763
32763
32763
60
61
60
61
61
60
60
59
60
59
58
55
32763
32763
44 0 0 1.5708
180
180
180
180
179
179
179
178
179
178
179
184
199
204
206
201
199
197
203
205
200
200
200
205
202
198
194
170
149
151
148
148
147
148
148
151
151
190
199
201
204
206
203
202
203
177
154
148
142
137
133
129
124
120
117
115
111
108
106
104
101
100
97
97
96
98
98
98
98
99
100
101
101
101
102
102
102
102
103
104
104
105
106
106
106
107
108
108
109
109
110
110
111
112
112
113
113
114
115
116
116
117
118
119
121
121
122
123
124
125
126
128
129
128
128
127
126
127
129
130
109
100
99
99
109
138
140
142
144
144
147
149
150
152
154
156
158
159
147
147
144
131
131
135
142
141
140
139
139
138
137
136
135
134
133
135
136
138
141
143
145
147
149
152
155
157
161
164
166
169
86
86
85
87
85
339
184
114
114
114
117
394
394
384
392
392
392
392
392
392
335
320
391
392
391
369
391
391
391
391
391
391
391
392
391
392
392
260
256
392
363
305
393
393
355
308
308
308
308
309
309
310
310
311
311
311
312
313
313
313
302
257
289
316
317
318
319
321
321
322
211
211
238
324
327
328
328
329
330
184
183
202
248
280
281
282
283
284
286
287
289
290
292
294
295
297
288
226
209
193
212
237
309
310
312
314
316
318
319
322
325
332
327
312
321
317
314
311
306
289
288
283
283
282
291
280
276
278
104
103
101
102
102
100
99
98
98
97
98
97
96
94
96
96
95
95
94
95
93
91
91
90
90
90
90
88
87
89
87
88
86
86
87
86
86
86
85
84
84
83
84
84
83
83
83
82
82
81
82
80
81
80
80
80
80
80
80
79
79
79
80
45 0 0 1.5708
163
166
171
167
164
165
162
168
171
167
165
166
164
170
172
167
166
166
166
172
170
168
166
167
172
173
170
168
168
173
177
172
171
170
172
178
174
173
172
176
180
176
174
176
181
181
178
177
180
184
182
181
182
186
185
185
186
189
188
188
191
193
192
192
197
195
196
199
199
200
202
202
203
204
206
211
210
212
212
214
216
217
219
220
437
438
439
442
443
445
790
780
776
769
762
756
749
736
728
725
725
722
719
715
711
721
742
744
748
753
757
926
915
901
920
911
887
869
865
862
445
442
446
633
633
639
602
617
857
416
418
421
433
440
448
461
468
473
486
494
504
430
427
427
425
424
421
421
420
418
416
418
446
459
464
501
545
550
468
563
566
492
429
430
428
427
427
426
426
425
425
425
425
425
425
425
425
425
425
425
427
425
426
426
428
428
428
429
429
429
430
430
431
431
430
429
433
436
437
438
438
363
346
347
349
349
349
350
350
352
352
353
353
355
356
357
358
359
360
361
363
363
362
362
364
366
368
370
370
389
398
406
402
396
411
413
415
417
407
401
396
397
400
402
404
402
445
440
434
428
423
421
416
411
407
402
397
393
389
384
381
376
374
365
361
358
353
350
349
345
342
339
337
335
333
329
327
324
322
320
317
314
312
310
308
305
303
302
300
298
297
295
293
291
289
288
286
286
284
282
280
279
277
230
222
226
267
273
271
270
269
228
220
220
220
220
221
240
259
260
259
249
237
213
219
223
205
204
204
203
203
203
202
202
201
201
201
200
200
200
199
200
199
199
199
199
199
200
237
218
212
212
212
212
207
211
211
211
211
211
211
46 0 0 1.5708
129
128
127
132
135
132
131
130
129
130
137
137
134
133
132
133
135
139
137
137
136
135
137
142
141
139
138
138
140
145
144
142
141
143
148
146
145
146
145
152
150
149
148
152
153
152
153
155
159
158
159
160
162
162
163
166
166
165
170
170
171
175
174
176
178
179
183
181
184
188
187
190
189
731
726
721
710
702
699
697
698
694
690
686
688
1051
892
893
894
897
874
870
889
886
899
848
846
842
1011
1008
558
507
451
422
421
844
841
838
835
832
828
827
408
399
402
404
418
429
439
447
459
473
484
500
519
418
413
412
412
411
409
410
410
408
406
405
437
453
477
459
487
504
470
477
486
625
423
423
423
421
421
421
421
421
422
422
422
422
423
423
423
424
424
425
425
427
425
424
425
428
429
430
432
432
433
433
434
435
437
437
438
440
441
442
443