ground_thruth.log

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

99
97
95
93
91
90
88
87
87
86
84
82
82
81
83
78
77
79
84
84
85
85
86
87
86
88
88
89
89
91
91
92
92
93
94
94
90
75
74
74
73
74
74
73
75
76
77
77
78
79
81
82
84
85
86
88
89
90
91
93
93
96
98
101
102
105
105
106
109
111
115
117
120
122
125
128
131
135
138
142
145
149
156
364
363
362
361
360
357
353
353
350
349
349
348
347
346
345
345
344
345
344
343
343
342
343
342
341
340
340
340
340
340
339
339
338
339
339
338
338
338
337
338
338
339
339
339
339
339
339
340
340
340
341
342
342
342
342
343
343
345
344
344
345
346
346
347
347
349
349
350
351
352
352
353
355
355
357
358
360
361
361
370
371
371
373
374
375
376
378
380
381
383
384
387
388
389
390
393
394
396
398
401
400
182
174
169
166
163
161
158
155
151
150
148
145
143
141
139
138
134
133
131
130
127
126
125
122
121
121
122
126
199
201
203
205
207
209
211
213
215
217
195
192
189
186
184
182
138
121
151
172
170
168
166
165
163
162
171
171
170
170
152
150
149
145
146
146
148
164
165
169
174
172
170
172
175
180
173
166
167
171
175
180
181
180
180
181
180
168
165
164
168
172
174
162
169
172
175
164
161
165
177
182
169
165
178
177
177
178
179
179
178
178
182
182
182
183
183
187
188
189
243
233
186
183
181
180
178
178
178
176
174
176
175
176
176
177
177
178
180
182
184
227
276
11 0 0 1.5708
130
135
139
143
149
114
114
164
167
166
99
99
104
103
104
103
103
86
83
82
83
83
83
83
83
83
83
84
83
82
84
83
83
83
83
84
84
85
84
84
85
85
85
85
86
85
85
86
86
86
86
86
86
86
87
87
87
88
88
88
88
88
88
89
90
89
90
90
91
91
91
90
90
91
92
91
92
93
93
94
94
94
95
96
95
97
97
98
98
98
99
100
101
100
101
102
102
103
104
106
106
106
107
108
108
109
111
110
112
113
113
115
115
117
118
119
119
127
127
127
132
384
380
378
374
372
368
364
363
360
357
354
351
349
349
352
352
349
346
345
342
341
338
337
334
333
332
329
327
325
324
323
321
318
317
316
314
313
308
303
303
301
300
298
297
296
296
294
293
293
292
290
290
289
288
287
287
285
285
284
283
283
281
282
281
280
280
280
279
279
279
277
277
276
276
276
276
275
275
274
275
274
275
275
274
274
273
272
273
272
273
273
274
274
272
273
274
275
274
275
275
275
275
275
276
276
275
276
277
278
278
279
279
279
279
280
280
281
281
283
282
284
285
285
286
288
288
295
302
307
310
311
312
314
315
315
317
316
318
321
321
322
324
326
327
328
330
331
332
334
335
339
339
330
324
324
324
108
107
100
97
96
93
92
90
90
89
85
86
83
83
82
81
79
78
78
77
77
75
74
73
71
73
71
70
69
69
67
67
65
66
65
64
65
63
63
62
62
62
61
60
60
59
58
59
58
57
58
56
57
58
56
55
55
54
54
53
52
52
52
52
51
52
52
58
69
115
117
117
115
114
113
112
112
111
110
110
109
108
108
107
12 0 0 1.5708
47
47
49
49
49
48
48
49
49
49
49
49
48
49
49
50
50
49
49
49
50
50
51
51
52
51
52
52
52
53
52
53
54
53
53
54
54
55
55
55
55
54
56
57
57
57
58
59
58
59
60
60
61
61
61
61
62
62
63
63
65
64
65
66
66
68
68
67
69
70
70
71
71
71
73
75
75
75
76
77
78
79
80
81
83
84
85
86
86
88
90
90
92
94
95
99
106
327
324
323
321
318
317
312
313
312
310
310
306
307
304
304
302
302
301
299
298
297
296
292
291
289
286
285
284
283
283
282
281
282
280
280
279
279
278
278
277
277
276
276
276
276
275
275
275
275
275
275
274
274
275
275
274
274
274
274
274
274
273
273
273
273
274
274
274
275
275
274
275
275
274
275
275
276
276
276
277
277
278
279
278
279
280
281
281
281
281
282
283
284
283
285
285
286
288
288
289
291
291
292
293
294
294
296
296
298
299
301
306
311
312
313
315
316
318
319
321
322
324
325
327
329
330
332
334
335
337
340
342
343
346
348
348
346
348
348
351
354
356
358
362
364
366
370
373
376
380
382
385
388
392
396
134
131
130
127
122
123
121
119
118
117
115
115
114
114
112
112
111
111
109
108
107
105
105
104
104
103
102
102
101
101
99
100
99
99
98
97
96
96
97
95
94
94
93
93
93
91
91
91
91
90
90
89
89
88
88
88
88
87
87
91
147
146
145
144
143
143
142
142
141
141
140
148
168
168
152
151
165
108
99
99
111
152
166
149
154
155
234
241
212
168
157
157
159
172
172
175
174
173
174
173
173
182
171
160
159
160
176
162
177
13 0 0 1.5708
100
104
103
102
102
102
101
99
99
99
100
100
99
100
100
102
103
105
107
111
114
119
122
125
130
134
139
143
149
156
162
170
177
186
194
206
218
231
246
261
281
304
331
358
32763
446
32763
706
711
893
32763
1650
32767
32767
2580
2317
2317
2318
2318
2320
2320
2322
32763
32767
32767
1473
32767
32767
32763
1141
32767
32767
32767
32767
32767
790
790
789
32763
32763
32763
32763
599
579
563
544
529
512
498
483
471
457
446
436
426
415
407
397
389
380
373
365
357
350
344
338
332
327
320
316
310
305
300
296
290
287
282
278
274
271
267
264
262
263
263
264
260
256
254
251
247
244
243
240
239
236
233
230
227
227
224
221
220
217
217
214
213
211
208
201
198
196
192
192
190
189
187
187
186
183
183
181
180
179
179
178
176
175
175
173
173
171
171
170
168
168
168
167
165
165
164
163
162
162
162
161
160
160
159
158
157
157
156
155
155
155
154
153
154
153
153
152
152
152
151
151
151
150
150
150
149
149
149
149
148
148
148
147
147
147
147
147
147
147
148
148
148
147
147
146
147
146
147
145
146
146
147
146
146
146
147
147
148
148
146
147
147
147
146
147
147
148
148
148
148
149
149
150
149
151
150
151
151
151
152
152
152
153
153
153
153
154
155
155
155
156
157
157
158
158
159
160
161
160
161
163
163
163
164
165
166
167
167
168
168
171
172
179
182
183
184
185
186
187
189
188
190
191
194
194
196
196
198
199
201
202
203
204
206
208
209
212
213
214
217
219
221
222
225
227
228
229
229
228
228
229
232
234
237
241
243
245
248
251
255
258
261
265
268
272
276
280
284
288
292
298
301
306
312
315
315
14 0 0 1.5708
68
70
73
76
79
83
85
90
93
98
102
109
116
123
132
141
153
165
179
196
218
246
279
323
396
507
677
867
32763
32767
3803
2282
2283
2285
2286
2286
2287
2289
2108
1882
32763
32767
1441
32763
32767
32767
1108
1108
32767
32767
32767
32767
32767
32767
758
758
757
691
32763
32763
612
593
575
559
545
532
516
502
491
479
467
456
446
436
427
417
409
401
394
386
379
372
366
359
354
347
341
336
331
326
320
315
311
307
303
299
295
292
287
283
280
277
273
271
268
264
261
259
256
253
250
246
245
244
245
245
245
245
242
240
238
236
234
232
230
228
226
224
223
222
220
218
218
216
213
212
209
209
207
206
205
204
203
203
201
200
198
192
190
189
188
186
185
185
184
183
182
182
181
180
180
179
177
177
177
176
175
174
174
172
173
171
171
171
171
170
170
169
169
169
168
168
167
166
167
165
166
164
165
164
163
164
163
164
163
162
161
161
161
161
162
162
164
163
163
162
163
164
162
162
162
163
163
163
163
163
164
164
162
161
163
161
162
163
162
164
164
164
164
164
164
165
164
166
166
167
167
167
168
168
169
169
170
170
171
171
171
172
173
174
174
175
175
176
176
177
178
179
179
180
181
181
182
183
184
184
185
186
187
188
189
190
190
193
192
194
194
197
196
198
199
202
202
203
205
212
216
218
219
221
223
223
225
228
229
231
232
234
236
238
240
242
245
247
249
252
255
257
258
262
264
268
266
266
266
268
270
274
278
281
283
288
289
296
300
304
307
313
317
322
327
331
336
343
348
355
354
359
355
359
365
372
377
385
393
400
408
415
421
441
32763
32763
527
536
538
543
560
575
595
613
32763
15 0 0 1.5708
68
70
74
76
79
82
86
89
94
99
104
110
116
123
132
142
153
164
178
197
217
248
276
319
391
487
674
869
32763
10590
3801
2282
2283
2284
2284
2287
2288
2288
2108
1882
32767
32767
1440
32767
32767
32767
1108
1107
32767
32767
32767
32767
32767
32767
758
758
757
687
32763
32763
611
592
575
559
545
532
517
502
491
479
467
456
446
436
426
417
408
400
393
386
379
371
366
359
354
347
341
336
331
325
320
316
311
307
302
299
295
292
287
283
281
276
274
270
267
265
261
258
255
253
250
244
245
244
245
245
245
244
241
240
238
234
234
232
230
227
227
224
223
221
220
218
217
215
213
210
211
208
207
207
206
204
202
202
200
201
199
194
190
189
189
186
186
184
184
183
182
181
181
180
180
179
178
177
177
176
175
174
174
172
172
171
171
171
170
170
170
170
170
169
168
167
167
167
165
165
165
165
165
164
163
163
163
163
163
163
161
162
161
161
161
162
164
162
163
162
163
162
161
162
161
163
163
162
163
164
164
164
162
162
163
162
162
163
163
164
164
164
164
164
165
165
165
166
166
167
168
168
168
169
169
169
170
170
171
171
171
173
173
173
174
174
175
176
177
178
178
179
180
180
181
181
182
183
184
185
185
186
187
188
189
190
191
193
193
193
194
195
197
198
199
201
202
203
205
209
217
218
219
220
222
223
225
228
229
231
233
235
237
239
240
243
245
247
250
252
254
256
258
262
264
267
266
266
266
268
271
274
277
281
285
289
289
296
300
303
308
312
318
322
327
331
337
342
349
355
355
358
355
360
365
371
378
385
392
399
407
415
423
441
32763
32763
525
536
538
542
558
576
593
611
32763
16 0 0 1.5708
69
70
73
76
79
82
86
90
94
98
103
110
116
123
132
143
152
165
178
197
217
251
277
324
393
493
675
871
32763
10589
3812
2283
2284
2285
2284
2285
2286
2288
2108
1881
32767
32767
1440
32767
32767
32767
1109
1106
32767
32767
32767
32767
32767
32767
757
758
757
685
32763
32763
611
591
574
558
545
530
516
502
491
479
467
455
445
435
426
416
409
401
394
386
379
371
366
358
354
347
341
336
330
325
320
316
312
307
302
299
295
291
287
283
280
277
273
270
268
264
261
258
255
252
250
247
245
243
243
244
245
244
241
240
237
236
234
231
230
227
226
225
223
221
219
218
217
215
212
211
210
208
206
207
205
204
202
203
200
197
200
193
189
188
189
187
186
185
184
183
183
182
181
181
180
179
179
177
176
176
175
175
174
174
174
173
172
171
172
171
170
171
170
169
169
168
168
167
167
167
166
166
166
165
164
164
164
164
163
164
163
163
163
163
162
162
164
164
163
163
162
162
162
161
162
162
163
162
163
163
164
163
162
163
163
163
163
163
164
165
164
164
165
165
166
166
167
167
167
168
168
167
168
170
170
170
171
171
171
171
171
172
172
174
174
174
175
176
176
177
178
178
180
180
181
181
181
182
184
185
185
186
187
188
189
189
191
191
193
193
194
195
197
198
199
201
202
202
204
212
216
218
218
221
222
224
225
228
229
232
233
234
236
237
240
243
245
246
250
252
254
256
259
262
264
267
266
265
266
267
271
274
277
281
284
289
291
295
301
304
308
313
317
322
327
331
336
342
348
355
354
359
355
360
365
372
377
384
391
400
407
415
423
441
32763
509
526
537
538
542
559
575
593
612
32763
17 0 0 1.5708
100
103
109
103
102
102
101
99
99
99
99
99
99
99
100
101
102
105
107
111
115
118
121
125
129
132
137
142
148
154
161
167
175
185
193
204
215
227
242
257
276
300
325
352
32763
32763
493
706
709
866
32763
32767
32767
32767
3800
2316
2317
2319
2317
2319
2319
2321
2142
1914
32767
1475
32763
32767
32767
1141
32767
32767
32767
32767
32767
792
791
789
708
32763
32763
32763
601
583
566
548
531
515
501
485
473
460
449
438
427
416
407
398
390
382
373
366
359
352
346
339
333
327
321
316
311
305
302
296
292
287
283
279
275
271
267
265
262
262
262
264
260
257
254
251
249
245
243
240
237
235
234
230
229
227
224
221
220
219
216
213
212
212
210
205
197
196
194
192
191
189
188
187
186
185
183
181
181
180
179
178
177
176
174
173
172
171
170
170
170
169
168
166
166
166
164
163
163
161
161
161
159
159
159
158
157
157
156
156
156
156
155
154
154
153
153
153
152
152
151
151
151
150
150
149
149
148
148
148
149
148
148
148
148
148
147
148
147
147
147
147
146
148
147
145
147
146
146
146
146
147
146
146
146
146
146
146
146
147
146
147
147
148
147
148
148
148
147
148
149
148
149
150
150
150
151
151
151
151
152
152
152
152
154
154
154
155
155
155
156
156
157
157
157
158
159
160
160
161
162
162
163
163
165
165
165
166
168
169
169
171
171
175
182
183
184
184
186
187
188
189
190
191
191
193
194
196
198
198
200
202
204
204
205
208
209
211
212
214
215
218
220
223
224
226
228
228
228
227
227
229
232
234
236
240
243
244
248
250
254
257
260
265
267
271
275
279
282
287
291
295
301
306
311
316
315
18 0 0 1.5708
70
73
76
79
82
85
89
93
98
103
109
116
122
130
141
152
163
177
193
215
242
272
315
384
478
673
861
1613
32767
3778
2281
2283
2284
2284
2287
2287
2288
2109
1883
32767
32767
1442
1438
32767
32767
1108
1108
32767
32767
32767
32767
32767
32767
756
758
756
703
32763
32763
613
595
578
562
546
533
518
504
491
481
468
457
447
437
427
420
410
402
394
387
380
372
366
359
354
347
342
337
331
326
321
317
311
308
304
299
296
291
287
285
280
276
274
269
268
264
261
258
254
251
250
247
246
243
243
244
245
245
241
240
237
236
234
232
230
228
226
224
223
222
220
218
217
216
213
211
211
209
207
206
205
204
203
201
201
200
197
192
189
189
189
185
185
184
183
183
182
181
180
179
178
178
176
176
175
175
175
173
173
172
172
172
171
170
170
170
170
168
169
168
167
167
167
167
165
165
164
165
164
164
164
164
162
162
162
163
162
162
162
162
163
162
163
163
162
162
163
161
161
162
163
162
162
162
162
163
164
163
163
164
163
162
162
162
163
163
163
163
164
164
164
165
165
165
166
167
166
166
167
167
168
168
168
169
170
170
171
171
172
173
173
173
174
175
176
176
176
178
178
179
179
180
181
182
183
183
184
185
186
187
188
189
190
191
192
194
194
195
196
197
198
200
201
204
204
210
216
217
219
220
223
224
225
226
228
231
233
235
237
238
239
242
245
247
249
252
255
256
259
261
264
266
266
266
266
267
270
273
277
280
285
288
290
294
299
303
307
312
317
321
326
330
336
340
347
354
356
357
354
358
364
370
376
384
392
399
406
414
423
437
32763
509
524
538
538
538
556
575
592
610
32763
649
19 0 0 1.5708
139
142
144
144
146
148
149
151
153
156
157
159
161
163
164
167
169
172
174
177
179
182
185
188
192
194
197
200
203
207
211
215
219
223
228
231
238
242
246
253
258
265
271
278
286
293
301
309
317
328
338
348
359
372
385
401
415
431
450
471
492
517
32763
619
666
681
685
815
822
863
883
994
1122
1230