3620 lines
53 KiB
JSON
3620 lines
53 KiB
JSON
{
|
|
"version": 1.0,
|
|
"date_generated": "2026-01-07",
|
|
"lattice_metadata": {
|
|
"motion_model": "diff",
|
|
"turning_radius": 0.1,
|
|
"grid_resolution": 0.02,
|
|
"stopping_threshold": 5,
|
|
"num_of_headings": 16,
|
|
"heading_angles": [
|
|
0.0,
|
|
0.4636476090008061,
|
|
0.7853981633974483,
|
|
1.1071487177940904,
|
|
1.5707963267948966,
|
|
2.0344439357957027,
|
|
2.356194490192345,
|
|
2.677945044588987,
|
|
3.141592653589793,
|
|
3.6052402625905993,
|
|
3.9269908169872414,
|
|
4.2487413713838835,
|
|
4.71238898038469,
|
|
5.176036589385496,
|
|
5.497787143782138,
|
|
5.81953769817878
|
|
],
|
|
"number_of_trajectories": 104
|
|
},
|
|
"primitives": [
|
|
{
|
|
"trajectory_id": 0,
|
|
"start_angle_index": 0,
|
|
"end_angle_index": 13,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
0.02044,
|
|
-0.00142,
|
|
6.121079291226373
|
|
],
|
|
[
|
|
0.04025,
|
|
-0.00662,
|
|
5.932070750858197
|
|
],
|
|
[
|
|
0.05874,
|
|
-0.01545,
|
|
5.743062210490022
|
|
],
|
|
[
|
|
0.07523,
|
|
-0.0276,
|
|
5.554053670121847
|
|
],
|
|
[
|
|
0.08915,
|
|
-0.04262,
|
|
5.365045129753671
|
|
],
|
|
[
|
|
0.1,
|
|
-0.06,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 1,
|
|
"start_angle_index": 0,
|
|
"end_angle_index": 14,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
0.01974,
|
|
-0.00135,
|
|
6.146474682680838
|
|
],
|
|
[
|
|
0.03911,
|
|
-0.00538,
|
|
6.009764058182089
|
|
],
|
|
[
|
|
0.05776,
|
|
-0.01201,
|
|
5.87305343368334
|
|
],
|
|
[
|
|
0.07532,
|
|
-0.02112,
|
|
5.736342809184592
|
|
],
|
|
[
|
|
0.09148,
|
|
-0.03254,
|
|
5.599632184685843
|
|
],
|
|
[
|
|
0.106,
|
|
-0.046,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.12,
|
|
-0.06,
|
|
5.497787143782138
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 2,
|
|
"start_angle_index": 0,
|
|
"end_angle_index": 15,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
6.128636104179318
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.9740869011790485
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 3,
|
|
"start_angle_index": 0,
|
|
"end_angle_index": 0,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04,
|
|
"poses": [
|
|
[
|
|
0.02,
|
|
0.0,
|
|
0.0
|
|
],
|
|
[
|
|
0.04,
|
|
0.0,
|
|
0.0
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 4,
|
|
"start_angle_index": 0,
|
|
"end_angle_index": 1,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.1545492030002687
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.3090984060005374
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 5,
|
|
"start_angle_index": 0,
|
|
"end_angle_index": 2,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
0.01974,
|
|
0.00135,
|
|
0.13671062449874857
|
|
],
|
|
[
|
|
0.03911,
|
|
0.00538,
|
|
0.27342124899749715
|
|
],
|
|
[
|
|
0.05776,
|
|
0.01201,
|
|
0.4101318734962457
|
|
],
|
|
[
|
|
0.07532,
|
|
0.02112,
|
|
0.5468424979949943
|
|
],
|
|
[
|
|
0.09148,
|
|
0.03254,
|
|
0.6835531224937428
|
|
],
|
|
[
|
|
0.106,
|
|
0.046,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.12,
|
|
0.06,
|
|
0.7853981633974483
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 6,
|
|
"start_angle_index": 0,
|
|
"end_angle_index": 3,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
0.02044,
|
|
0.00142,
|
|
0.16210601595321314
|
|
],
|
|
[
|
|
0.04025,
|
|
0.00662,
|
|
0.35111455632138866
|
|
],
|
|
[
|
|
0.05874,
|
|
0.01545,
|
|
0.540123096689564
|
|
],
|
|
[
|
|
0.07523,
|
|
0.0276,
|
|
0.7291316370577395
|
|
],
|
|
[
|
|
0.08915,
|
|
0.04262,
|
|
0.9181401774259149
|
|
],
|
|
[
|
|
0.1,
|
|
0.06,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 7,
|
|
"start_angle_index": 1,
|
|
"end_angle_index": 15,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0193,
|
|
0.0075,
|
|
0.27818856540048365
|
|
],
|
|
[
|
|
0.03965,
|
|
0.01132,
|
|
0.0927295218001612
|
|
],
|
|
[
|
|
0.06035,
|
|
0.01132,
|
|
6.190455785379425
|
|
],
|
|
[
|
|
0.0807,
|
|
0.0075,
|
|
6.004996741779102
|
|
],
|
|
[
|
|
0.1,
|
|
0.0,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 8,
|
|
"start_angle_index": 1,
|
|
"end_angle_index": 15,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.01911,
|
|
0.00801,
|
|
0.3311768635720044
|
|
],
|
|
[
|
|
0.0391,
|
|
0.01344,
|
|
0.1987061181432026
|
|
],
|
|
[
|
|
0.05964,
|
|
0.01618,
|
|
0.06623537271440089
|
|
],
|
|
[
|
|
0.08036,
|
|
0.01618,
|
|
6.216949934465186
|
|
],
|
|
[
|
|
0.1009,
|
|
0.01344,
|
|
6.084479189036384
|
|
],
|
|
[
|
|
0.12089,
|
|
0.00801,
|
|
5.952008443607582
|
|
],
|
|
[
|
|
0.14,
|
|
0.0,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 9,
|
|
"start_angle_index": 1,
|
|
"end_angle_index": 0,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.4636476090008061
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.23182380450040305
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 10,
|
|
"start_angle_index": 1,
|
|
"end_angle_index": 1,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
0.02,
|
|
0.01,
|
|
0.4636476090008061
|
|
],
|
|
[
|
|
0.04,
|
|
0.02,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 11,
|
|
"start_angle_index": 1,
|
|
"end_angle_index": 2,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.4636476090008061
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.6245228861991272
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.7853981633974483
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 12,
|
|
"start_angle_index": 1,
|
|
"end_angle_index": 3,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.01844,
|
|
0.01116,
|
|
0.6245228861991272
|
|
],
|
|
[
|
|
0.03487,
|
|
0.02513,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.04884,
|
|
0.04156,
|
|
0.9462734405957693
|
|
],
|
|
[
|
|
0.06,
|
|
0.06,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 13,
|
|
"start_angle_index": 2,
|
|
"end_angle_index": 15,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
0.01414,
|
|
0.01201,
|
|
0.6142956219961762
|
|
],
|
|
[
|
|
0.0302,
|
|
0.0213,
|
|
0.4346384168300125
|
|
],
|
|
[
|
|
0.04766,
|
|
0.02758,
|
|
0.2549812116638488
|
|
],
|
|
[
|
|
0.06597,
|
|
0.03063,
|
|
0.075324006497685
|
|
],
|
|
[
|
|
0.08452,
|
|
0.03036,
|
|
6.178852108511108
|
|
],
|
|
[
|
|
0.10273,
|
|
0.02678,
|
|
5.999194903344944
|
|
],
|
|
[
|
|
0.12,
|
|
0.02,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 14,
|
|
"start_angle_index": 2,
|
|
"end_angle_index": 1,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
0.01347,
|
|
0.01212,
|
|
0.6813758341424526
|
|
],
|
|
[
|
|
0.02812,
|
|
0.02279,
|
|
0.577353504887457
|
|
],
|
|
[
|
|
0.04379,
|
|
0.03188,
|
|
0.47333117563246124
|
|
],
|
|
[
|
|
0.06,
|
|
0.04,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 15,
|
|
"start_angle_index": 2,
|
|
"end_angle_index": 1,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.6245228861991272
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 16,
|
|
"start_angle_index": 2,
|
|
"end_angle_index": 2,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.05657,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.05657,
|
|
"poses": [
|
|
[
|
|
0.01333,
|
|
0.01333,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.02667,
|
|
0.02667,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.04,
|
|
0.04,
|
|
0.7853981633974483
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 17,
|
|
"start_angle_index": 2,
|
|
"end_angle_index": 3,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
0.01212,
|
|
0.01347,
|
|
0.8894204926524439
|
|
],
|
|
[
|
|
0.02279,
|
|
0.02812,
|
|
0.9934428219074396
|
|
],
|
|
[
|
|
0.03188,
|
|
0.04379,
|
|
1.0974651511624351
|
|
],
|
|
[
|
|
0.04,
|
|
0.06,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 18,
|
|
"start_angle_index": 2,
|
|
"end_angle_index": 3,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.9462734405957693
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 19,
|
|
"start_angle_index": 2,
|
|
"end_angle_index": 5,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
0.01201,
|
|
0.01414,
|
|
0.9565007047987204
|
|
],
|
|
[
|
|
0.0213,
|
|
0.0302,
|
|
1.1361579099648842
|
|
],
|
|
[
|
|
0.02758,
|
|
0.04766,
|
|
1.3158151151310478
|
|
],
|
|
[
|
|
0.03063,
|
|
0.06597,
|
|
1.4954723202972116
|
|
],
|
|
[
|
|
0.03036,
|
|
0.08452,
|
|
1.6751295254633751
|
|
],
|
|
[
|
|
0.02678,
|
|
0.10273,
|
|
1.8547867306295387
|
|
],
|
|
[
|
|
0.02,
|
|
0.12,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 20,
|
|
"start_angle_index": 3,
|
|
"end_angle_index": 1,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.01116,
|
|
0.01844,
|
|
0.9462734405957693
|
|
],
|
|
[
|
|
0.02513,
|
|
0.03487,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.04156,
|
|
0.04884,
|
|
0.6245228861991272
|
|
],
|
|
[
|
|
0.06,
|
|
0.06,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 21,
|
|
"start_angle_index": 3,
|
|
"end_angle_index": 2,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.1071487177940904
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.9998985329952097
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.892648348196329
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.7853981633974483
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 22,
|
|
"start_angle_index": 3,
|
|
"end_angle_index": 3,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
0.01,
|
|
0.02,
|
|
1.1071487177940904
|
|
],
|
|
[
|
|
0.02,
|
|
0.04,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 23,
|
|
"start_angle_index": 3,
|
|
"end_angle_index": 4,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.1071487177940904
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.261697920794359
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.416247123794628
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.5707963267948966
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 24,
|
|
"start_angle_index": 3,
|
|
"end_angle_index": 5,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0075,
|
|
0.0193,
|
|
1.292607761394413
|
|
],
|
|
[
|
|
0.01132,
|
|
0.03965,
|
|
1.4780668049947354
|
|
],
|
|
[
|
|
0.01132,
|
|
0.06035,
|
|
1.663525848595058
|
|
],
|
|
[
|
|
0.0075,
|
|
0.0807,
|
|
1.8489848921953804
|
|
],
|
|
[
|
|
0.0,
|
|
0.1,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 25,
|
|
"start_angle_index": 3,
|
|
"end_angle_index": 5,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.00801,
|
|
0.01911,
|
|
1.239619463222892
|
|
],
|
|
[
|
|
0.01344,
|
|
0.0391,
|
|
1.372090208651694
|
|
],
|
|
[
|
|
0.01618,
|
|
0.05964,
|
|
1.5045609540804956
|
|
],
|
|
[
|
|
0.01618,
|
|
0.08036,
|
|
1.6370316995092975
|
|
],
|
|
[
|
|
0.01344,
|
|
0.1009,
|
|
1.769502444938099
|
|
],
|
|
[
|
|
0.00801,
|
|
0.12089,
|
|
1.9019731903669008
|
|
],
|
|
[
|
|
0.0,
|
|
0.14,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 26,
|
|
"start_angle_index": 4,
|
|
"end_angle_index": 1,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
0.00142,
|
|
0.02044,
|
|
1.4086903108416835
|
|
],
|
|
[
|
|
0.00662,
|
|
0.04025,
|
|
1.219681770473508
|
|
],
|
|
[
|
|
0.01545,
|
|
0.05874,
|
|
1.0306732301053325
|
|
],
|
|
[
|
|
0.0276,
|
|
0.07523,
|
|
0.841664689737157
|
|
],
|
|
[
|
|
0.04262,
|
|
0.08915,
|
|
0.6526561493689816
|
|
],
|
|
[
|
|
0.06,
|
|
0.1,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 27,
|
|
"start_angle_index": 4,
|
|
"end_angle_index": 2,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
0.00135,
|
|
0.01974,
|
|
1.434085702296148
|
|
],
|
|
[
|
|
0.00538,
|
|
0.03911,
|
|
1.2973750777973994
|
|
],
|
|
[
|
|
0.01201,
|
|
0.05776,
|
|
1.160664453298651
|
|
],
|
|
[
|
|
0.02112,
|
|
0.07532,
|
|
1.0239538287999024
|
|
],
|
|
[
|
|
0.03254,
|
|
0.09148,
|
|
0.887243204301154
|
|
],
|
|
[
|
|
0.046,
|
|
0.106,
|
|
0.7853981633974483
|
|
],
|
|
[
|
|
0.06,
|
|
0.12,
|
|
0.7853981633974483
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 28,
|
|
"start_angle_index": 4,
|
|
"end_angle_index": 3,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.5707963267948966
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.416247123794628
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.261697920794359
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 29,
|
|
"start_angle_index": 4,
|
|
"end_angle_index": 4,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.02,
|
|
1.5707963267948966
|
|
],
|
|
[
|
|
0.0,
|
|
0.04,
|
|
1.5707963267948966
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 30,
|
|
"start_angle_index": 4,
|
|
"end_angle_index": 5,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.5707963267948966
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.7253455297951652
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.879894732795434
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 31,
|
|
"start_angle_index": 4,
|
|
"end_angle_index": 6,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
-0.00135,
|
|
0.01974,
|
|
1.7075069512936452
|
|
],
|
|
[
|
|
-0.00538,
|
|
0.03911,
|
|
1.8442175757923938
|
|
],
|
|
[
|
|
-0.01201,
|
|
0.05776,
|
|
1.9809282002911424
|
|
],
|
|
[
|
|
-0.02112,
|
|
0.07532,
|
|
2.117638824789891
|
|
],
|
|
[
|
|
-0.03254,
|
|
0.09148,
|
|
2.2543494492886396
|
|
],
|
|
[
|
|
-0.046,
|
|
0.106,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
-0.06,
|
|
0.12,
|
|
2.356194490192345
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 32,
|
|
"start_angle_index": 4,
|
|
"end_angle_index": 7,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
-0.00142,
|
|
0.02044,
|
|
1.7329023427481096
|
|
],
|
|
[
|
|
-0.00662,
|
|
0.04025,
|
|
1.9219108831162852
|
|
],
|
|
[
|
|
-0.01545,
|
|
0.05874,
|
|
2.110919423484461
|
|
],
|
|
[
|
|
-0.0276,
|
|
0.07523,
|
|
2.299927963852636
|
|
],
|
|
[
|
|
-0.04262,
|
|
0.08915,
|
|
2.4889365042208116
|
|
],
|
|
[
|
|
-0.06,
|
|
0.1,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 33,
|
|
"start_angle_index": 5,
|
|
"end_angle_index": 3,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.0075,
|
|
0.0193,
|
|
1.8489848921953802
|
|
],
|
|
[
|
|
-0.01132,
|
|
0.03965,
|
|
1.6635258485950577
|
|
],
|
|
[
|
|
-0.01132,
|
|
0.06035,
|
|
1.4780668049947352
|
|
],
|
|
[
|
|
-0.0075,
|
|
0.0807,
|
|
1.2926077613944127
|
|
],
|
|
[
|
|
0.0,
|
|
0.1,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 34,
|
|
"start_angle_index": 5,
|
|
"end_angle_index": 3,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.00801,
|
|
0.01911,
|
|
1.901973190366901
|
|
],
|
|
[
|
|
-0.01344,
|
|
0.0391,
|
|
1.7695024449380992
|
|
],
|
|
[
|
|
-0.01618,
|
|
0.05964,
|
|
1.6370316995092975
|
|
],
|
|
[
|
|
-0.01618,
|
|
0.08036,
|
|
1.5045609540804956
|
|
],
|
|
[
|
|
-0.01344,
|
|
0.1009,
|
|
1.3720902086516942
|
|
],
|
|
[
|
|
-0.00801,
|
|
0.12089,
|
|
1.2396194632228923
|
|
],
|
|
[
|
|
0.0,
|
|
0.14,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 35,
|
|
"start_angle_index": 5,
|
|
"end_angle_index": 4,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.0344439357957027
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.8026201312952996
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
1.5707963267948966
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 36,
|
|
"start_angle_index": 5,
|
|
"end_angle_index": 5,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
-0.01,
|
|
0.02,
|
|
2.0344439357957027
|
|
],
|
|
[
|
|
-0.02,
|
|
0.04,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 37,
|
|
"start_angle_index": 5,
|
|
"end_angle_index": 6,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.0344439357957027
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.1953192129940238
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.356194490192345
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 38,
|
|
"start_angle_index": 5,
|
|
"end_angle_index": 7,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.01116,
|
|
0.01844,
|
|
2.1953192129940238
|
|
],
|
|
[
|
|
-0.02513,
|
|
0.03487,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
-0.04156,
|
|
0.04884,
|
|
2.517069767390666
|
|
],
|
|
[
|
|
-0.06,
|
|
0.06,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 39,
|
|
"start_angle_index": 6,
|
|
"end_angle_index": 9,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
-0.01414,
|
|
0.01201,
|
|
2.527297031593617
|
|
],
|
|
[
|
|
-0.0302,
|
|
0.0213,
|
|
2.7069542367597808
|
|
],
|
|
[
|
|
-0.04766,
|
|
0.02758,
|
|
2.886611441925944
|
|
],
|
|
[
|
|
-0.06597,
|
|
0.03063,
|
|
3.066268647092108
|
|
],
|
|
[
|
|
-0.08452,
|
|
0.03036,
|
|
3.2459258522582717
|
|
],
|
|
[
|
|
-0.10273,
|
|
0.02678,
|
|
3.4255830574244355
|
|
],
|
|
[
|
|
-0.12,
|
|
0.02,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 40,
|
|
"start_angle_index": 6,
|
|
"end_angle_index": 3,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
-0.01201,
|
|
0.01414,
|
|
2.1850919487910727
|
|
],
|
|
[
|
|
-0.0213,
|
|
0.0302,
|
|
2.005434743624909
|
|
],
|
|
[
|
|
-0.02758,
|
|
0.04766,
|
|
1.8257775384587454
|
|
],
|
|
[
|
|
-0.03063,
|
|
0.06597,
|
|
1.6461203332925816
|
|
],
|
|
[
|
|
-0.03036,
|
|
0.08452,
|
|
1.466463128126418
|
|
],
|
|
[
|
|
-0.02678,
|
|
0.10273,
|
|
1.2868059229602544
|
|
],
|
|
[
|
|
-0.02,
|
|
0.12,
|
|
1.1071487177940904
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 41,
|
|
"start_angle_index": 6,
|
|
"end_angle_index": 5,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
-0.01212,
|
|
0.01347,
|
|
2.252172160937349
|
|
],
|
|
[
|
|
-0.02279,
|
|
0.02812,
|
|
2.1481498316823537
|
|
],
|
|
[
|
|
-0.03188,
|
|
0.04379,
|
|
2.044127502427358
|
|
],
|
|
[
|
|
-0.04,
|
|
0.06,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 42,
|
|
"start_angle_index": 6,
|
|
"end_angle_index": 5,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.1953192129940238
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 43,
|
|
"start_angle_index": 6,
|
|
"end_angle_index": 6,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.05657,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.05657,
|
|
"poses": [
|
|
[
|
|
-0.01333,
|
|
0.01333,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
-0.02667,
|
|
0.02667,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
-0.04,
|
|
0.04,
|
|
2.356194490192345
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 44,
|
|
"start_angle_index": 6,
|
|
"end_angle_index": 7,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
-0.01347,
|
|
0.01212,
|
|
2.4602168194473406
|
|
],
|
|
[
|
|
-0.02812,
|
|
0.02279,
|
|
2.564239148702336
|
|
],
|
|
[
|
|
-0.04379,
|
|
0.03188,
|
|
2.6682614779573317
|
|
],
|
|
[
|
|
-0.06,
|
|
0.04,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 45,
|
|
"start_angle_index": 6,
|
|
"end_angle_index": 7,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.517069767390666
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 46,
|
|
"start_angle_index": 7,
|
|
"end_angle_index": 9,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.0193,
|
|
0.0075,
|
|
2.8634040881893092
|
|
],
|
|
[
|
|
-0.03965,
|
|
0.01132,
|
|
3.048863131789632
|
|
],
|
|
[
|
|
-0.06035,
|
|
0.01132,
|
|
3.2343221753899547
|
|
],
|
|
[
|
|
-0.0807,
|
|
0.0075,
|
|
3.419781218990277
|
|
],
|
|
[
|
|
-0.1,
|
|
0.0,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 47,
|
|
"start_angle_index": 7,
|
|
"end_angle_index": 9,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.01911,
|
|
0.00801,
|
|
2.810415790017789
|
|
],
|
|
[
|
|
-0.0391,
|
|
0.01344,
|
|
2.9428865354465903
|
|
],
|
|
[
|
|
-0.05964,
|
|
0.01618,
|
|
3.075357280875392
|
|
],
|
|
[
|
|
-0.08036,
|
|
0.01618,
|
|
3.207828026304194
|
|
],
|
|
[
|
|
-0.1009,
|
|
0.01344,
|
|
3.3402987717329955
|
|
],
|
|
[
|
|
-0.12089,
|
|
0.00801,
|
|
3.4727695171617974
|
|
],
|
|
[
|
|
-0.14,
|
|
0.0,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 48,
|
|
"start_angle_index": 7,
|
|
"end_angle_index": 5,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.01844,
|
|
0.01116,
|
|
2.517069767390666
|
|
],
|
|
[
|
|
-0.03487,
|
|
0.02513,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
-0.04884,
|
|
0.04156,
|
|
2.1953192129940238
|
|
],
|
|
[
|
|
-0.06,
|
|
0.06,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 49,
|
|
"start_angle_index": 7,
|
|
"end_angle_index": 6,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.677945044588987
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.5706948597901063
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.4634446749912255
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.356194490192345
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 50,
|
|
"start_angle_index": 7,
|
|
"end_angle_index": 7,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
-0.02,
|
|
0.01,
|
|
2.677945044588987
|
|
],
|
|
[
|
|
-0.04,
|
|
0.02,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 51,
|
|
"start_angle_index": 7,
|
|
"end_angle_index": 8,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.677945044588987
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.832494247589256
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.9870434505895243
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.141592653589793
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 52,
|
|
"start_angle_index": 8,
|
|
"end_angle_index": 9,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.141592653589793
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.296141856590062
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.4506910595903304
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 53,
|
|
"start_angle_index": 8,
|
|
"end_angle_index": 10,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
-0.01974,
|
|
-0.00135,
|
|
3.2783032780885417
|
|
],
|
|
[
|
|
-0.03911,
|
|
-0.00538,
|
|
3.4150139025872903
|
|
],
|
|
[
|
|
-0.05776,
|
|
-0.01201,
|
|
3.551724527086039
|
|
],
|
|
[
|
|
-0.07532,
|
|
-0.02112,
|
|
3.6884351515847875
|
|
],
|
|
[
|
|
-0.09148,
|
|
-0.03254,
|
|
3.825145776083536
|
|
],
|
|
[
|
|
-0.106,
|
|
-0.046,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
-0.12,
|
|
-0.06,
|
|
3.9269908169872414
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 54,
|
|
"start_angle_index": 8,
|
|
"end_angle_index": 11,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
-0.02044,
|
|
-0.00142,
|
|
3.303698669543006
|
|
],
|
|
[
|
|
-0.04025,
|
|
-0.00662,
|
|
3.492707209911182
|
|
],
|
|
[
|
|
-0.05874,
|
|
-0.01545,
|
|
3.6817157502793574
|
|
],
|
|
[
|
|
-0.07523,
|
|
-0.0276,
|
|
3.8707242906475328
|
|
],
|
|
[
|
|
-0.08915,
|
|
-0.04262,
|
|
4.059732831015708
|
|
],
|
|
[
|
|
-0.1,
|
|
-0.06,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 55,
|
|
"start_angle_index": 8,
|
|
"end_angle_index": 5,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
-0.02044,
|
|
0.00142,
|
|
2.97948663763658
|
|
],
|
|
[
|
|
-0.04025,
|
|
0.00662,
|
|
2.7904780972684042
|
|
],
|
|
[
|
|
-0.05874,
|
|
0.01545,
|
|
2.601469556900229
|
|
],
|
|
[
|
|
-0.07523,
|
|
0.0276,
|
|
2.4124610165320535
|
|
],
|
|
[
|
|
-0.08915,
|
|
0.04262,
|
|
2.223452476163878
|
|
],
|
|
[
|
|
-0.1,
|
|
0.06,
|
|
2.0344439357957027
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 56,
|
|
"start_angle_index": 8,
|
|
"end_angle_index": 6,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
-0.01974,
|
|
0.00135,
|
|
3.0048820290910445
|
|
],
|
|
[
|
|
-0.03911,
|
|
0.00538,
|
|
2.868171404592296
|
|
],
|
|
[
|
|
-0.05776,
|
|
0.01201,
|
|
2.7314607800935473
|
|
],
|
|
[
|
|
-0.07532,
|
|
0.02112,
|
|
2.5947501555947987
|
|
],
|
|
[
|
|
-0.09148,
|
|
0.03254,
|
|
2.45803953109605
|
|
],
|
|
[
|
|
-0.106,
|
|
0.046,
|
|
2.356194490192345
|
|
],
|
|
[
|
|
-0.12,
|
|
0.06,
|
|
2.356194490192345
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 57,
|
|
"start_angle_index": 8,
|
|
"end_angle_index": 7,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.141592653589793
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.9870434505895243
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.832494247589256
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 58,
|
|
"start_angle_index": 8,
|
|
"end_angle_index": 8,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04,
|
|
"poses": [
|
|
[
|
|
-0.02,
|
|
0.0,
|
|
3.141592653589793
|
|
],
|
|
[
|
|
-0.04,
|
|
0.0,
|
|
3.141592653589793
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 59,
|
|
"start_angle_index": 9,
|
|
"end_angle_index": 9,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
-0.02,
|
|
-0.01,
|
|
3.6052402625905993
|
|
],
|
|
[
|
|
-0.04,
|
|
-0.02,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 60,
|
|
"start_angle_index": 9,
|
|
"end_angle_index": 10,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.6052402625905993
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.7661155397889203
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.9269908169872414
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 61,
|
|
"start_angle_index": 9,
|
|
"end_angle_index": 11,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.01844,
|
|
-0.01116,
|
|
3.7661155397889203
|
|
],
|
|
[
|
|
-0.03487,
|
|
-0.02513,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
-0.04884,
|
|
-0.04156,
|
|
4.0878660941855625
|
|
],
|
|
[
|
|
-0.06,
|
|
-0.06,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 62,
|
|
"start_angle_index": 9,
|
|
"end_angle_index": 7,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.0193,
|
|
-0.0075,
|
|
3.419781218990277
|
|
],
|
|
[
|
|
-0.03965,
|
|
-0.01132,
|
|
3.2343221753899543
|
|
],
|
|
[
|
|
-0.06035,
|
|
-0.01132,
|
|
3.0488631317896315
|
|
],
|
|
[
|
|
-0.0807,
|
|
-0.0075,
|
|
2.8634040881893092
|
|
],
|
|
[
|
|
-0.1,
|
|
0.0,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 63,
|
|
"start_angle_index": 9,
|
|
"end_angle_index": 7,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.01911,
|
|
-0.00801,
|
|
3.4727695171617974
|
|
],
|
|
[
|
|
-0.0391,
|
|
-0.01344,
|
|
3.340298771732996
|
|
],
|
|
[
|
|
-0.05964,
|
|
-0.01618,
|
|
3.207828026304194
|
|
],
|
|
[
|
|
-0.08036,
|
|
-0.01618,
|
|
3.075357280875392
|
|
],
|
|
[
|
|
-0.1009,
|
|
-0.01344,
|
|
2.9428865354465907
|
|
],
|
|
[
|
|
-0.12089,
|
|
-0.00801,
|
|
2.810415790017789
|
|
],
|
|
[
|
|
-0.14,
|
|
0.0,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 64,
|
|
"start_angle_index": 9,
|
|
"end_angle_index": 8,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.6052402625905993
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.373416458090196
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.141592653589793
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 65,
|
|
"start_angle_index": 10,
|
|
"end_angle_index": 9,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
-0.01347,
|
|
-0.01212,
|
|
3.8229684877322456
|
|
],
|
|
[
|
|
-0.02812,
|
|
-0.02279,
|
|
3.7189461584772503
|
|
],
|
|
[
|
|
-0.04379,
|
|
-0.03188,
|
|
3.6149238292222545
|
|
],
|
|
[
|
|
-0.06,
|
|
-0.04,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 66,
|
|
"start_angle_index": 10,
|
|
"end_angle_index": 9,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.7661155397889203
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 67,
|
|
"start_angle_index": 10,
|
|
"end_angle_index": 10,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.05657,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.05657,
|
|
"poses": [
|
|
[
|
|
-0.01333,
|
|
-0.01333,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
-0.02667,
|
|
-0.02667,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
-0.04,
|
|
-0.04,
|
|
3.9269908169872414
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 68,
|
|
"start_angle_index": 10,
|
|
"end_angle_index": 11,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
-0.01212,
|
|
-0.01347,
|
|
4.031013146242238
|
|
],
|
|
[
|
|
-0.02279,
|
|
-0.02812,
|
|
4.135035475497233
|
|
],
|
|
[
|
|
-0.03188,
|
|
-0.04379,
|
|
4.239057804752228
|
|
],
|
|
[
|
|
-0.04,
|
|
-0.06,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 69,
|
|
"start_angle_index": 10,
|
|
"end_angle_index": 11,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.0878660941855625
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 70,
|
|
"start_angle_index": 10,
|
|
"end_angle_index": 13,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
-0.01201,
|
|
-0.01414,
|
|
4.098093358388514
|
|
],
|
|
[
|
|
-0.0213,
|
|
-0.0302,
|
|
4.277750563554678
|
|
],
|
|
[
|
|
-0.02758,
|
|
-0.04766,
|
|
4.457407768720841
|
|
],
|
|
[
|
|
-0.03063,
|
|
-0.06597,
|
|
4.6370649738870044
|
|
],
|
|
[
|
|
-0.03036,
|
|
-0.08452,
|
|
4.816722179053168
|
|
],
|
|
[
|
|
-0.02678,
|
|
-0.10273,
|
|
4.996379384219332
|
|
],
|
|
[
|
|
-0.02,
|
|
-0.12,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 71,
|
|
"start_angle_index": 10,
|
|
"end_angle_index": 7,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
-0.01414,
|
|
-0.01201,
|
|
3.7558882755859693
|
|
],
|
|
[
|
|
-0.0302,
|
|
-0.0213,
|
|
3.5762310704198055
|
|
],
|
|
[
|
|
-0.04766,
|
|
-0.02758,
|
|
3.396573865253642
|
|
],
|
|
[
|
|
-0.06597,
|
|
-0.03063,
|
|
3.2169166600874783
|
|
],
|
|
[
|
|
-0.08452,
|
|
-0.03036,
|
|
3.0372594549213145
|
|
],
|
|
[
|
|
-0.10273,
|
|
-0.02678,
|
|
2.8576022497551508
|
|
],
|
|
[
|
|
-0.12,
|
|
-0.02,
|
|
2.677945044588987
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 72,
|
|
"start_angle_index": 11,
|
|
"end_angle_index": 9,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.01116,
|
|
-0.01844,
|
|
4.0878660941855625
|
|
],
|
|
[
|
|
-0.02513,
|
|
-0.03487,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
-0.04156,
|
|
-0.04884,
|
|
3.7661155397889203
|
|
],
|
|
[
|
|
-0.06,
|
|
-0.06,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 73,
|
|
"start_angle_index": 11,
|
|
"end_angle_index": 10,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.2487413713838835
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.141491186585003
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.034241001786122
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
3.9269908169872414
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 74,
|
|
"start_angle_index": 11,
|
|
"end_angle_index": 11,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
-0.01,
|
|
-0.02,
|
|
4.2487413713838835
|
|
],
|
|
[
|
|
-0.02,
|
|
-0.04,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 75,
|
|
"start_angle_index": 11,
|
|
"end_angle_index": 12,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.2487413713838835
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.403290574384152
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.557839777384421
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.71238898038469
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 76,
|
|
"start_angle_index": 11,
|
|
"end_angle_index": 13,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.0075,
|
|
-0.0193,
|
|
4.434200414984206
|
|
],
|
|
[
|
|
-0.01132,
|
|
-0.03965,
|
|
4.619659458584529
|
|
],
|
|
[
|
|
-0.01132,
|
|
-0.06035,
|
|
4.805118502184851
|
|
],
|
|
[
|
|
-0.0075,
|
|
-0.0807,
|
|
4.9905775457851735
|
|
],
|
|
[
|
|
0.0,
|
|
-0.1,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 77,
|
|
"start_angle_index": 11,
|
|
"end_angle_index": 13,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
-0.00801,
|
|
-0.01911,
|
|
4.381212116812685
|
|
],
|
|
[
|
|
-0.01344,
|
|
-0.0391,
|
|
4.513682862241487
|
|
],
|
|
[
|
|
-0.01618,
|
|
-0.05964,
|
|
4.646153607670289
|
|
],
|
|
[
|
|
-0.01618,
|
|
-0.08036,
|
|
4.77862435309909
|
|
],
|
|
[
|
|
-0.01344,
|
|
-0.1009,
|
|
4.911095098527892
|
|
],
|
|
[
|
|
-0.00801,
|
|
-0.12089,
|
|
5.043565843956694
|
|
],
|
|
[
|
|
0.0,
|
|
-0.14,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 78,
|
|
"start_angle_index": 12,
|
|
"end_angle_index": 9,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
-0.00142,
|
|
-0.02044,
|
|
4.550282964431476
|
|
],
|
|
[
|
|
-0.00662,
|
|
-0.04025,
|
|
4.361274424063301
|
|
],
|
|
[
|
|
-0.01545,
|
|
-0.05874,
|
|
4.172265883695125
|
|
],
|
|
[
|
|
-0.0276,
|
|
-0.07523,
|
|
3.98325734332695
|
|
],
|
|
[
|
|
-0.04262,
|
|
-0.08915,
|
|
3.7942488029587746
|
|
],
|
|
[
|
|
-0.06,
|
|
-0.1,
|
|
3.6052402625905993
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 79,
|
|
"start_angle_index": 12,
|
|
"end_angle_index": 10,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
-0.00135,
|
|
-0.01974,
|
|
4.575678355885941
|
|
],
|
|
[
|
|
-0.00538,
|
|
-0.03911,
|
|
4.4389677313871925
|
|
],
|
|
[
|
|
-0.01201,
|
|
-0.05776,
|
|
4.302257106888444
|
|
],
|
|
[
|
|
-0.02112,
|
|
-0.07532,
|
|
4.165546482389695
|
|
],
|
|
[
|
|
-0.03254,
|
|
-0.09148,
|
|
4.028835857890947
|
|
],
|
|
[
|
|
-0.046,
|
|
-0.106,
|
|
3.9269908169872414
|
|
],
|
|
[
|
|
-0.06,
|
|
-0.12,
|
|
3.9269908169872414
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 80,
|
|
"start_angle_index": 12,
|
|
"end_angle_index": 11,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.71238898038469
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.557839777384421
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.403290574384152
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 81,
|
|
"start_angle_index": 12,
|
|
"end_angle_index": 12,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
-0.02,
|
|
4.71238898038469
|
|
],
|
|
[
|
|
0.0,
|
|
-0.04,
|
|
4.71238898038469
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 82,
|
|
"start_angle_index": 12,
|
|
"end_angle_index": 13,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.71238898038469
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.866938183384958
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.021487386385227
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 83,
|
|
"start_angle_index": 12,
|
|
"end_angle_index": 14,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.14485,
|
|
"trajectory_length": 0.13862,
|
|
"arc_length": 0.11376,
|
|
"straight_length": 0.02485,
|
|
"poses": [
|
|
[
|
|
0.00135,
|
|
-0.01974,
|
|
4.849099604883438
|
|
],
|
|
[
|
|
0.00538,
|
|
-0.03911,
|
|
4.985810229382187
|
|
],
|
|
[
|
|
0.01201,
|
|
-0.05776,
|
|
5.1225208538809355
|
|
],
|
|
[
|
|
0.02112,
|
|
-0.07532,
|
|
5.259231478379684
|
|
],
|
|
[
|
|
0.03254,
|
|
-0.09148,
|
|
5.395942102878433
|
|
],
|
|
[
|
|
0.046,
|
|
-0.106,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.06,
|
|
-0.12,
|
|
5.497787143782138
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 84,
|
|
"start_angle_index": 12,
|
|
"end_angle_index": 15,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10854,
|
|
"trajectory_length": 0.12309,
|
|
"arc_length": 0.12017,
|
|
"straight_length": 0.00292,
|
|
"poses": [
|
|
[
|
|
0.00142,
|
|
-0.02044,
|
|
4.874494996337903
|
|
],
|
|
[
|
|
0.00662,
|
|
-0.04025,
|
|
5.063503536706079
|
|
],
|
|
[
|
|
0.01545,
|
|
-0.05874,
|
|
5.252512077074254
|
|
],
|
|
[
|
|
0.0276,
|
|
-0.07523,
|
|
5.441520617442429
|
|
],
|
|
[
|
|
0.04262,
|
|
-0.08915,
|
|
5.630529157810605
|
|
],
|
|
[
|
|
0.06,
|
|
-0.1,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 85,
|
|
"start_angle_index": 13,
|
|
"end_angle_index": 11,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0075,
|
|
-0.0193,
|
|
4.9905775457851735
|
|
],
|
|
[
|
|
0.01132,
|
|
-0.03965,
|
|
4.80511850218485
|
|
],
|
|
[
|
|
0.01132,
|
|
-0.06035,
|
|
4.619659458584528
|
|
],
|
|
[
|
|
0.0075,
|
|
-0.0807,
|
|
4.434200414984206
|
|
],
|
|
[
|
|
0.0,
|
|
-0.1,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 86,
|
|
"start_angle_index": 13,
|
|
"end_angle_index": 11,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.00801,
|
|
-0.01911,
|
|
5.043565843956694
|
|
],
|
|
[
|
|
0.01344,
|
|
-0.0391,
|
|
4.911095098527892
|
|
],
|
|
[
|
|
0.01618,
|
|
-0.05964,
|
|
4.77862435309909
|
|
],
|
|
[
|
|
0.01618,
|
|
-0.08036,
|
|
4.646153607670289
|
|
],
|
|
[
|
|
0.01344,
|
|
-0.1009,
|
|
4.513682862241487
|
|
],
|
|
[
|
|
0.00801,
|
|
-0.12089,
|
|
4.381212116812685
|
|
],
|
|
[
|
|
0.0,
|
|
-0.14,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 87,
|
|
"start_angle_index": 13,
|
|
"end_angle_index": 12,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.176036589385496
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.944212784885092
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
4.71238898038469
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 88,
|
|
"start_angle_index": 13,
|
|
"end_angle_index": 13,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
0.01,
|
|
-0.02,
|
|
5.176036589385496
|
|
],
|
|
[
|
|
0.02,
|
|
-0.04,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 89,
|
|
"start_angle_index": 13,
|
|
"end_angle_index": 14,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.176036589385496
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.336911866583817
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.497787143782138
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 90,
|
|
"start_angle_index": 13,
|
|
"end_angle_index": 15,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.01116,
|
|
-0.01844,
|
|
5.336911866583817
|
|
],
|
|
[
|
|
0.02513,
|
|
-0.03487,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.04156,
|
|
-0.04884,
|
|
5.658662420980459
|
|
],
|
|
[
|
|
0.06,
|
|
-0.06,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 91,
|
|
"start_angle_index": 14,
|
|
"end_angle_index": 11,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
0.01201,
|
|
-0.01414,
|
|
5.326684602380865
|
|
],
|
|
[
|
|
0.0213,
|
|
-0.0302,
|
|
5.147027397214702
|
|
],
|
|
[
|
|
0.02758,
|
|
-0.04766,
|
|
4.967370192048539
|
|
],
|
|
[
|
|
0.03063,
|
|
-0.06597,
|
|
4.787712986882375
|
|
],
|
|
[
|
|
0.03036,
|
|
-0.08452,
|
|
4.608055781716211
|
|
],
|
|
[
|
|
0.02678,
|
|
-0.10273,
|
|
4.428398576550047
|
|
],
|
|
[
|
|
0.02,
|
|
-0.12,
|
|
4.2487413713838835
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 92,
|
|
"start_angle_index": 14,
|
|
"end_angle_index": 13,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
0.01212,
|
|
-0.01347,
|
|
5.393764814527143
|
|
],
|
|
[
|
|
0.02279,
|
|
-0.02812,
|
|
5.289742485272146
|
|
],
|
|
[
|
|
0.03188,
|
|
-0.04379,
|
|
5.185720156017151
|
|
],
|
|
[
|
|
0.04,
|
|
-0.06,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 93,
|
|
"start_angle_index": 14,
|
|
"end_angle_index": 13,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.336911866583817
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 94,
|
|
"start_angle_index": 14,
|
|
"end_angle_index": 14,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.05657,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.05657,
|
|
"poses": [
|
|
[
|
|
0.01333,
|
|
-0.01333,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.02667,
|
|
-0.02667,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.04,
|
|
-0.04,
|
|
5.497787143782138
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 95,
|
|
"start_angle_index": 14,
|
|
"end_angle_index": 15,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.17428,
|
|
"trajectory_length": 0.07252,
|
|
"arc_length": 0.05607,
|
|
"straight_length": 0.01644,
|
|
"poses": [
|
|
[
|
|
0.01347,
|
|
-0.01212,
|
|
5.601809473037133
|
|
],
|
|
[
|
|
0.02812,
|
|
-0.02279,
|
|
5.7058318022921295
|
|
],
|
|
[
|
|
0.04379,
|
|
-0.03188,
|
|
5.809854131547125
|
|
],
|
|
[
|
|
0.06,
|
|
-0.04,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 96,
|
|
"start_angle_index": 14,
|
|
"end_angle_index": 15,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.658662420980459
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 97,
|
|
"start_angle_index": 14,
|
|
"end_angle_index": 1,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.10342,
|
|
"trajectory_length": 0.13006,
|
|
"arc_length": 0.12918,
|
|
"straight_length": 0.00088,
|
|
"poses": [
|
|
[
|
|
0.01414,
|
|
-0.01201,
|
|
5.6688896851834105
|
|
],
|
|
[
|
|
0.0302,
|
|
-0.0213,
|
|
5.848546890349573
|
|
],
|
|
[
|
|
0.04766,
|
|
-0.02758,
|
|
6.028204095515737
|
|
],
|
|
[
|
|
0.06597,
|
|
-0.03063,
|
|
6.207861300681901
|
|
],
|
|
[
|
|
0.08452,
|
|
-0.03036,
|
|
0.10433319866847846
|
|
],
|
|
[
|
|
0.10273,
|
|
-0.02678,
|
|
0.28399040383464214
|
|
],
|
|
[
|
|
0.12,
|
|
-0.02,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 98,
|
|
"start_angle_index": 15,
|
|
"end_angle_index": 13,
|
|
"left_turn": false,
|
|
"trajectory_radius": 0.13416,
|
|
"trajectory_length": 0.08633,
|
|
"arc_length": 0.08633,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.01844,
|
|
-0.01116,
|
|
5.658662420980459
|
|
],
|
|
[
|
|
0.03487,
|
|
-0.02513,
|
|
5.497787143782138
|
|
],
|
|
[
|
|
0.04884,
|
|
-0.04156,
|
|
5.336911866583817
|
|
],
|
|
[
|
|
0.06,
|
|
-0.06,
|
|
5.176036589385496
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 99,
|
|
"start_angle_index": 15,
|
|
"end_angle_index": 14,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.81953769817878
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.712287513379899
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.605037328581019
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.497787143782138
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 100,
|
|
"start_angle_index": 15,
|
|
"end_angle_index": 15,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.04472,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.04472,
|
|
"poses": [
|
|
[
|
|
0.02,
|
|
-0.01,
|
|
5.81953769817878
|
|
],
|
|
[
|
|
0.04,
|
|
-0.02,
|
|
5.81953769817878
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 101,
|
|
"start_angle_index": 15,
|
|
"end_angle_index": 0,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.0,
|
|
"trajectory_length": 0.0,
|
|
"arc_length": 0.0,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.81953769817878
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
5.9740869011790485
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
6.128636104179318
|
|
],
|
|
[
|
|
0.0,
|
|
0.0,
|
|
0.0
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 102,
|
|
"start_angle_index": 15,
|
|
"end_angle_index": 1,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.1118,
|
|
"trajectory_length": 0.10367,
|
|
"arc_length": 0.10367,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.0193,
|
|
-0.0075,
|
|
6.004996741779102
|
|
],
|
|
[
|
|
0.03965,
|
|
-0.01132,
|
|
6.190455785379425
|
|
],
|
|
[
|
|
0.06035,
|
|
-0.01132,
|
|
0.09272952180016131
|
|
],
|
|
[
|
|
0.0807,
|
|
-0.0075,
|
|
0.2781885654004837
|
|
],
|
|
[
|
|
0.1,
|
|
0.0,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
},
|
|
{
|
|
"trajectory_id": 103,
|
|
"start_angle_index": 15,
|
|
"end_angle_index": 1,
|
|
"left_turn": true,
|
|
"trajectory_radius": 0.15652,
|
|
"trajectory_length": 0.14514,
|
|
"arc_length": 0.14514,
|
|
"straight_length": 0.0,
|
|
"poses": [
|
|
[
|
|
0.01911,
|
|
-0.00801,
|
|
5.952008443607582
|
|
],
|
|
[
|
|
0.0391,
|
|
-0.01344,
|
|
6.084479189036384
|
|
],
|
|
[
|
|
0.05964,
|
|
-0.01618,
|
|
6.216949934465186
|
|
],
|
|
[
|
|
0.08036,
|
|
-0.01618,
|
|
0.06623537271440089
|
|
],
|
|
[
|
|
0.1009,
|
|
-0.01344,
|
|
0.19870611814320255
|
|
],
|
|
[
|
|
0.12089,
|
|
-0.00801,
|
|
0.3311768635720042
|
|
],
|
|
[
|
|
0.14,
|
|
0.0,
|
|
0.4636476090008061
|
|
]
|
|
]
|
|
}
|
|
]
|
|
} |