|
|
|
|
|
|
|
|
|
|
|
|
|
|
joint_positions_assembled_1 = [[-8.303461, -48.278357, 71.508258, -115.343, 89.659, -5.706]]
|
|
|
|
|
|
|
|
|
|
joint_positions_assembled_2 = [[92.442,-41.967,60.096,-110.133,90.041,11.741]]
|
|
|
|
|
|
|
|
|
|
joint_positions_assembled_3 = [[-8.437,-52.830,64.769,-101.519,91.959,-9.155]]
|
|
|
|
|
|
|
|
|
|
joint_positions_assembled_4 = [[92.553,-45.178,53.196,-97.284,97.995,15.177]]
|
|
|
|
|
|
|
|
|
|
Pose_1 = [
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1398, 0.0349, -1.5580],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1400, 0.0349, -1.5534],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1403, 0.0350, -1.5440],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1408, 0.0350, -1.5301],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1415, 0.0350, -1.5114],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1409, 0.0350, -1.4882],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1399, 0.0349, -1.4602],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1388, 0.0349, -1.4276],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1375, 0.0347, -1.3904],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1361, 0.0345, -1.3484],
|
|
|
|
|
[1549.5000, -66.3590, 360.2500, -3.1345, 0.0342, -1.3025],
|
|
|
|
|
[1547.7000, -64.6380, 360.4500, -3.1329, 0.0339, -1.2559],
|
|
|
|
|
[1544.4000, -61.5410, 360.8300, -3.1313, 0.0334, -1.2093],
|
|
|
|
|
[1539.7000, -57.0660, 361.3700, -3.1298, 0.0329, -1.1628],
|
|
|
|
|
[1533.6000, -51.2150, 362.0700, -3.1282, 0.0323, -1.1162],
|
|
|
|
|
[1526.0000, -43.9870, 362.9400, -3.1268, 0.0317, -1.0696],
|
|
|
|
|
[1517.0000, -35.3830, 363.9800, -3.1253, 0.0309, -1.0231],
|
|
|
|
|
[1506.6000, -25.4010, 365.1800, -3.1239, 0.0302, -0.9765],
|
|
|
|
|
[1494.7000, -14.0430, 366.5500, -3.1225, 0.0293, -0.9300],
|
|
|
|
|
[1481.4000, -1.3082, 368.0900, -3.1212, 0.0284, -0.8834],
|
|
|
|
|
[1467.0000, 12.4160, 369.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1452.6000, 26.1840, 371.4000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1438.2000, 39.9510, 373.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1423.8000, 53.7190, 374.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1409.3000, 67.4860, 376.3800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1394.9000, 81.2540, 378.0400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1380.5000, 95.0210, 379.7000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1366.1000, 108.7900, 381.3600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1351.7000, 122.5600, 383.0200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1337.3000, 136.3200, 384.6800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1322.9000, 150.0900, 386.3400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1308.5000, 163.8600, 388.0000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1294.1000, 177.6300, 389.6600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1279.7000, 191.3900, 391.3200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1265.2000, 205.1600, 392.9800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1250.8000, 218.9300, 394.6400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1236.4000, 232.7000, 396.3000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1222.0000, 246.4600, 397.9600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1204.0000, 263.6700, 400.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1189.6000, 277.4400, 401.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1175.2000, 291.2100, 403.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1160.8000, 304.9800, 405.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1146.3000, 318.7400, 406.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1131.9000, 332.5100, 408.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1117.5000, 346.2800, 409.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1103.1000, 360.0500, 411.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1088.7000, 373.8100, 413.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1074.3000, 387.5800, 414.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1059.9000, 401.3500, 416.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1045.5000, 415.1100, 418.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1031.0000, 428.8800, 419.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1016.6000, 442.6500, 421.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1002.2000, 456.4200, 423.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[987.8000, 470.1800, 424.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[973.3900, 483.9500, 426.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[958.9800, 497.7200, 428.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[944.5700, 511.4900, 429.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[930.1600, 525.2500, 431.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[915.7500, 539.0200, 433.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[901.3300, 552.7900, 434.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[886.9200, 566.5600, 436.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[872.5100, 580.3200, 438.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[858.1000, 594.0900, 439.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[843.6900, 607.8600, 441.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[829.2700, 621.6300, 443.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[814.8600, 635.3900, 444.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[800.4500, 649.1600, 446.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[786.0400, 662.9300, 448.1600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[771.6300, 676.7000, 449.8200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[757.2200, 690.4600, 451.4800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[742.8000, 704.2300, 453.1400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[728.3900, 718.0000, 454.8000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[713.9800, 731.7700, 456.4600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[699.5700, 745.5300, 458.1200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[685.1500, 759.3000, 459.7800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[670.7400, 773.0700, 461.4400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[656.3300, 786.8400, 463.1000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[641.9200, 800.6000, 464.7600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[627.5100, 814.3700, 466.4200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[613.1000, 828.1400, 468.0800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[598.6800, 841.9100, 469.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[584.2700, 855.6700, 471.3900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[569.8600, 869.4400, 473.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[555.4500, 883.2100, 474.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[541.0400, 896.9800, 476.3700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[526.6200, 910.7400, 478.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[512.2100, 924.5100, 479.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[497.8000, 938.2800, 481.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[483.3900, 952.0400, 483.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[468.9800, 965.8100, 484.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[454.5600, 979.5800, 486.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[440.1500, 993.3500, 487.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[425.7400, 1007.1000, 489.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[411.3300, 1020.9000, 491.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[396.9200, 1034.7000, 492.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[382.5000, 1048.4000, 494.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[368.0900, 1062.2000, 496.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[353.6800, 1076.0000, 497.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[339.2700, 1089.7000, 499.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[324.8600, 1103.5000, 501.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[310.4500, 1117.2000, 502.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[296.0300, 1131.0000, 504.5900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[281.6200, 1144.8000, 506.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[267.2100, 1158.6000, 507.9100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[252.8000, 1172.3000, 509.5700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[238.3900, 1186.1000, 511.2300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[223.9700, 1199.9000, 512.8900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[209.5600, 1213.6000, 514.5500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[195.1500, 1227.4000, 516.2100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[180.7400, 1241.2000, 517.8700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[166.3300, 1254.9000, 519.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[151.9100, 1268.7000, 521.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[137.5000, 1282.5000, 522.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[123.0900, 1296.2000, 524.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[105.0800, 1313.4000, 526.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[90.6650, 1327.2000, 528.2400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[76.2530, 1341.0000, 529.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[61.8410, 1354.7000, 531.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[47.4290, 1368.5000, 533.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[33.0170, 1382.3000, 534.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[18.6050, 1396.0000, 536.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[4.1933, 1409.8000, 538.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-10.2190, 1423.6000, 539.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-24.6310, 1437.3000, 541.5100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-39.0420, 1451.1000, 543.1700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-53.4540, 1464.9000, 544.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-67.8660, 1478.7000, 546.4900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-82.2780, 1492.4000, 548.1500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-96.6900, 1506.2000, 549.8100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-111.1000, 1520.0000, 551.4700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-125.5100, 1533.7000, 553.1300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-139.9300, 1547.5000, 554.7900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-154.3400, 1561.3000, 556.4500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-168.1900, 1574.5000, 558.0500, -3.1200, 0.0275, -0.8428],
|
|
|
|
|
[-180.6100, 1586.3000, 559.4800, -3.1182, 0.0260, -0.7756],
|
|
|
|
|
[-191.5900, 1596.8000, 560.7400, -3.1166, 0.0245, -0.7119],
|
|
|
|
|
[-201.1300, 1606.0000, 561.8400, -3.1152, 0.0229, -0.6517],
|
|
|
|
|
[-209.2300, 1613.7000, 562.7700, -3.1139, 0.0214, -0.5949],
|
|
|
|
|
[-215.8800, 1620.0000, 563.5400, -3.1128, 0.0199, -0.5417],
|
|
|
|
|
[-221.1000, 1625.0000, 564.1400, -3.1119, 0.0184, -0.4920],
|
|
|
|
|
[-224.8700, 1628.6000, 564.5800, -3.1111, 0.0170, -0.4458],
|
|
|
|
|
[-227.2000, 1630.9000, 564.8400, -3.1103, 0.0157, -0.4030],
|
|
|
|
|
[-228.0900, 1631.7000, 564.9500, -3.1098, 0.0145, -0.3638],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1093, 0.0133, -0.3280],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1088, 0.0123, -0.2957],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1085, 0.0113, -0.2669],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1082, 0.0105, -0.2416],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1080, 0.0098, -0.2198],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1078, 0.0091, -0.2015],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1077, 0.0086, -0.1867],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1076, 0.0083, -0.1754],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0080, -0.1675],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0078, -0.1631],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0078, -0.1622]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
Pose_1_2 = [
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 554.1737, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 543.3974, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 532.6211, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 521.8447, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 511.0684, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 500.2921, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 489.5158, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 478.7395, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 467.9632, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 457.1868, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 446.4105, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 435.6342, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 424.8579, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 414.0816, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 403.3053, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 392.5289, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 381.7526, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 370.9763, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0078, -0.1622]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
Pose_2 = [
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0078, -0.1631],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0080, -0.1675],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1076, 0.0083, -0.1754],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1077, 0.0086, -0.1867],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1078, 0.0091, -0.2015],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1080, 0.0098, -0.2198],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1082, 0.0105, -0.2416],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1085, 0.0113, -0.2669],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1088, 0.0123, -0.2957],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1093, 0.0133, -0.3280],
|
|
|
|
|
[-228.0900, 1631.7000, 360.2500, -3.1098, 0.0145, -0.3638],
|
|
|
|
|
[-227.2000, 1630.9000, 360.4500, -3.1103, 0.0157, -0.4030],
|
|
|
|
|
[-224.8700, 1628.6000, 360.8300, -3.1111, 0.0170, -0.4458],
|
|
|
|
|
[-221.1000, 1625.0000, 361.3700, -3.1119, 0.0184, -0.4920],
|
|
|
|
|
[-215.8800, 1620.0000, 362.0700, -3.1128, 0.0199, -0.5417],
|
|
|
|
|
[-209.2300, 1613.7000, 362.9400, -3.1139, 0.0214, -0.5949],
|
|
|
|
|
[-201.1300, 1606.0000, 363.9800, -3.1152, 0.0229, -0.6517],
|
|
|
|
|
[-191.5900, 1596.8000, 365.1800, -3.1166, 0.0245, -0.7119],
|
|
|
|
|
[-180.6100, 1586.3000, 366.5500, -3.1182, 0.0260, -0.7756],
|
|
|
|
|
[-168.1900, 1574.5000, 368.0900, -3.1200, 0.0275, -0.8428],
|
|
|
|
|
[-154.3400, 1561.3000, 369.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-139.9300, 1547.5000, 371.4000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-125.5100, 1533.7000, 373.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-111.1000, 1520.0000, 374.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-96.6900, 1506.2000, 376.3800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-82.2780, 1492.4000, 378.0400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-67.8660, 1478.7000, 379.7000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-53.4540, 1464.9000, 381.3600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-39.0420, 1451.1000, 383.0200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-24.6310, 1437.3000, 384.6800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-10.2190, 1423.6000, 386.3400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[4.1933, 1409.8000, 388.0000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[18.6050, 1396.0000, 389.6600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[33.0170, 1382.3000, 391.3200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[47.4290, 1368.5000, 392.9800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[61.8410, 1354.7000, 394.6400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[76.2530, 1341.0000, 396.3000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[90.6650, 1327.2000, 397.9600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[105.0800, 1313.4000, 400.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[123.0900, 1296.2000, 401.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[137.5000, 1282.5000, 403.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[151.9100, 1268.7000, 405.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[166.3300, 1254.9000, 406.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[180.7400, 1241.2000, 408.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[195.1500, 1227.4000, 409.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[209.5600, 1213.6000, 411.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[223.9700, 1199.9000, 413.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[238.3900, 1186.1000, 414.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[252.8000, 1172.3000, 416.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[267.2100, 1158.6000, 418.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[281.6200, 1144.8000, 419.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[296.0300, 1131.0000, 421.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[310.4500, 1117.2000, 423.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[324.8600, 1103.5000, 424.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[339.2700, 1089.7000, 426.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[353.6800, 1076.0000, 428.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[368.0900, 1062.2000, 429.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[382.5000, 1048.4000, 431.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[396.9200, 1034.7000, 433.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[411.3300, 1020.9000, 434.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[425.7400, 1007.1000, 436.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[440.1500, 993.3500, 438.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[454.5600, 979.5800, 439.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[468.9800, 965.8100, 441.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[483.3900, 952.0400, 443.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[497.8000, 938.2800, 444.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[512.2100, 924.5100, 446.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[526.6200, 910.7400, 448.1600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[541.0400, 896.9800, 449.8200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[555.4500, 883.2100, 451.4800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[569.8600, 869.4400, 453.1400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[584.2700, 855.6700, 454.8000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[598.6800, 841.9100, 456.4600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[613.1000, 828.1400, 458.1200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[627.5100, 814.3700, 459.7800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[641.9200, 800.6000, 461.4400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[656.3300, 786.8400, 463.1000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[670.7400, 773.0700, 464.7600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[685.1500, 759.3000, 466.4200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[699.5700, 745.5300, 468.0800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[713.9800, 731.7700, 469.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[728.3900, 718.0000, 471.3900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[742.8000, 704.2300, 473.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[757.2200, 690.4600, 474.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[771.6300, 676.7000, 476.3700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[786.0400, 662.9300, 478.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[800.4500, 649.1600, 479.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[814.8600, 635.3900, 481.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[829.2700, 621.6300, 483.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[843.6900, 607.8600, 484.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[858.1000, 594.0900, 486.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[872.5100, 580.3200, 487.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[886.9200, 566.5600, 489.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[901.3300, 552.7900, 491.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[915.7500, 539.0200, 492.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[930.1600, 525.2500, 494.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[944.5700, 511.4900, 496.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[958.9800, 497.7200, 497.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[973.3900, 483.9500, 499.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[987.8000, 470.1800, 501.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1002.2000, 456.4200, 502.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1016.6000, 442.6500, 504.5900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1031.0000, 428.8800, 506.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1045.5000, 415.1100, 507.9100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1059.9000, 401.3500, 509.5700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1074.3000, 387.5800, 511.2300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1088.7000, 373.8100, 512.8900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1103.1000, 360.0500, 514.5500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1117.5000, 346.2800, 516.2100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1131.9000, 332.5100, 517.8700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1146.3000, 318.7400, 519.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1160.8000, 304.9800, 521.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1175.2000, 291.2100, 522.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1189.6000, 277.4400, 524.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1204.0000, 263.6700, 526.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1222.0000, 246.4600, 528.2400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1236.4000, 232.7000, 529.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1250.8000, 218.9300, 531.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1265.2000, 205.1600, 533.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1279.7000, 191.3900, 534.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1294.1000, 177.6300, 536.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1308.5000, 163.8600, 538.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1322.9000, 150.0900, 539.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1337.3000, 136.3200, 541.5100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1351.7000, 122.5600, 543.1700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1366.1000, 108.7900, 544.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1380.5000, 95.0210, 546.4900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1394.9000, 81.2540, 548.1500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1409.3000, 67.4860, 549.8100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1423.8000, 53.7190, 551.4700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1438.2000, 39.9510, 553.1300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1452.6000, 26.1840, 554.7900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1467.0000, 12.4160, 556.4500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1481.4000, -1.3082, 558.0500, -3.1212, 0.0284, -0.8834],
|
|
|
|
|
[1494.7000, -14.0430, 559.4800, -3.1225, 0.0293, -0.9300],
|
|
|
|
|
[1506.6000, -25.4010, 560.7400, -3.1239, 0.0302, -0.9765],
|
|
|
|
|
[1517.0000, -35.3830, 561.8400, -3.1253, 0.0309, -1.0231],
|
|
|
|
|
[1526.0000, -43.9870, 562.7700, -3.1268, 0.0317, -1.0696],
|
|
|
|
|
[1533.6000, -51.2150, 563.5400, -3.1282, 0.0323, -1.1162],
|
|
|
|
|
[1539.7000, -57.0660, 564.1400, -3.1298, 0.0329, -1.1628],
|
|
|
|
|
[1544.4000, -61.5410, 564.5800, -3.1313, 0.0334, -1.2093],
|
|
|
|
|
[1547.7000, -64.6380, 564.8400, -3.1329, 0.0339, -1.2559],
|
|
|
|
|
[1549.5000, -66.3590, 564.9500, -3.1345, 0.0342, -1.3025],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1361, 0.0345, -1.3484],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1375, 0.0347, -1.3904],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1388, 0.0349, -1.4276],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1399, 0.0349, -1.4602],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1409, 0.0350, -1.4882],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1415, 0.0350, -1.5114],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1408, 0.0350, -1.5301],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1403, 0.0350, -1.5440],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1400, 0.0349, -1.5534],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1398, 0.0349, -1.5580],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1398, 0.0349, -1.5584]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
Pose_2_1 = [
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 554.1737, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 543.3974, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 532.6211, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 521.8447, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 511.0684, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 500.2921, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 489.5158, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 478.7395, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 467.9632, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 457.1868, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 446.4105, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 435.6342, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 424.8579, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 414.0816, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 403.3053, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 392.5289, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 381.7526, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 370.9763, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1398, 0.0349, -1.5584]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
Pose_3 = [
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1398, 0.0349, -1.5580],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1400, 0.0349, -1.5534],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1403, 0.0350, -1.5440],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1408, 0.0350, -1.5301],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1415, 0.0350, -1.5114],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1409, 0.0350, -1.4882],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1399, 0.0349, -1.4602],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1388, 0.0349, -1.4276],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1375, 0.0347, -1.3904],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, -3.1361, 0.0345, -1.3484],
|
|
|
|
|
[1549.5000, -66.3590, 564.9500, -3.1345, 0.0342, -1.3025],
|
|
|
|
|
[1547.7000, -64.6380, 564.8400, -3.1329, 0.0339, -1.2559],
|
|
|
|
|
[1544.4000, -61.5410, 564.5800, -3.1313, 0.0334, -1.2093],
|
|
|
|
|
[1539.7000, -57.0660, 564.1400, -3.1298, 0.0329, -1.1628],
|
|
|
|
|
[1533.6000, -51.2150, 563.5400, -3.1282, 0.0323, -1.1162],
|
|
|
|
|
[1526.0000, -43.9870, 562.7700, -3.1268, 0.0317, -1.0696],
|
|
|
|
|
[1517.0000, -35.3830, 561.8400, -3.1253, 0.0309, -1.0231],
|
|
|
|
|
[1506.6000, -25.4010, 560.7400, -3.1239, 0.0302, -0.9765],
|
|
|
|
|
[1494.7000, -14.0430, 559.4800, -3.1225, 0.0293, -0.9300],
|
|
|
|
|
[1481.4000, -1.3082, 558.0500, -3.1212, 0.0284, -0.8834],
|
|
|
|
|
[1467.0000, 12.4160, 556.4500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1452.6000, 26.1840, 554.7900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1438.2000, 39.9510, 553.1300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1423.8000, 53.7190, 551.4700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1409.3000, 67.4860, 549.8100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1394.9000, 81.2540, 548.1500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1380.5000, 95.0210, 546.4900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1366.1000, 108.7900, 544.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1351.7000, 122.5600, 543.1700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1337.3000, 136.3200, 541.5100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1322.9000, 150.0900, 539.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1308.5000, 163.8600, 538.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1294.1000, 177.6300, 536.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1279.7000, 191.3900, 534.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1265.2000, 205.1600, 533.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1250.8000, 218.9300, 531.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1236.4000, 232.7000, 529.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1222.0000, 246.4600, 528.2400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1204.0000, 263.6700, 526.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1189.6000, 277.4400, 524.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1175.2000, 291.2100, 522.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1160.8000, 304.9800, 521.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1146.3000, 318.7400, 519.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1131.9000, 332.5100, 517.8700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1117.5000, 346.2800, 516.2100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1103.1000, 360.0500, 514.5500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1088.7000, 373.8100, 512.8900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1074.3000, 387.5800, 511.2300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1059.9000, 401.3500, 509.5700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1045.5000, 415.1100, 507.9100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1031.0000, 428.8800, 506.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1016.6000, 442.6500, 504.5900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1002.2000, 456.4200, 502.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[987.8000, 470.1800, 501.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[973.3900, 483.9500, 499.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[958.9800, 497.7200, 497.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[944.5700, 511.4900, 496.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[930.1600, 525.2500, 494.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[915.7500, 539.0200, 492.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[901.3300, 552.7900, 491.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[886.9200, 566.5600, 489.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[872.5100, 580.3200, 487.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[858.1000, 594.0900, 486.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[843.6900, 607.8600, 484.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[829.2700, 621.6300, 483.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[814.8600, 635.3900, 481.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[800.4500, 649.1600, 479.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[786.0400, 662.9300, 478.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[771.6300, 676.7000, 476.3700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[757.2200, 690.4600, 474.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[742.8000, 704.2300, 473.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[728.3900, 718.0000, 471.3900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[713.9800, 731.7700, 469.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[699.5700, 745.5300, 468.0800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[685.1500, 759.3000, 466.4200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[670.7400, 773.0700, 464.7600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[656.3300, 786.8400, 463.1000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[641.9200, 800.6000, 461.4400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[627.5100, 814.3700, 459.7800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[613.1000, 828.1400, 458.1200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[598.6800, 841.9100, 456.4600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[584.2700, 855.6700, 454.8000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[569.8600, 869.4400, 453.1400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[555.4500, 883.2100, 451.4800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[541.0400, 896.9800, 449.8200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[526.6200, 910.7400, 448.1600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[512.2100, 924.5100, 446.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[497.8000, 938.2800, 444.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[483.3900, 952.0400, 443.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[468.9800, 965.8100, 441.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[454.5600, 979.5800, 439.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[440.1500, 993.3500, 438.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[425.7400, 1007.1000, 436.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[411.3300, 1020.9000, 434.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[396.9200, 1034.7000, 433.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[382.5000, 1048.4000, 431.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[368.0900, 1062.2000, 429.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[353.6800, 1076.0000, 428.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[339.2700, 1089.7000, 426.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[324.8600, 1103.5000, 424.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[310.4500, 1117.2000, 423.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[296.0300, 1131.0000, 421.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[281.6200, 1144.8000, 419.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[267.2100, 1158.6000, 418.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[252.8000, 1172.3000, 416.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[238.3900, 1186.1000, 414.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[223.9700, 1199.9000, 413.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[209.5600, 1213.6000, 411.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[195.1500, 1227.4000, 409.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[180.7400, 1241.2000, 408.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[166.3300, 1254.9000, 406.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[151.9100, 1268.7000, 405.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[137.5000, 1282.5000, 403.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[123.0900, 1296.2000, 401.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[105.0800, 1313.4000, 400.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[90.6650, 1327.2000, 397.9600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[76.2530, 1341.0000, 396.3000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[61.8410, 1354.7000, 394.6400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[47.4290, 1368.5000, 392.9800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[33.0170, 1382.3000, 391.3200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[18.6050, 1396.0000, 389.6600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[4.1933, 1409.8000, 388.0000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-10.2190, 1423.6000, 386.3400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-24.6310, 1437.3000, 384.6800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-39.0420, 1451.1000, 383.0200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-53.4540, 1464.9000, 381.3600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-67.8660, 1478.7000, 379.7000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-82.2780, 1492.4000, 378.0400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-96.6900, 1506.2000, 376.3800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-111.1000, 1520.0000, 374.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-125.5100, 1533.7000, 373.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-139.9300, 1547.5000, 371.4000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-154.3400, 1561.3000, 369.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-168.1900, 1574.5000, 368.0900, -3.1200, 0.0275, -0.8428],
|
|
|
|
|
[-180.6100, 1586.3000, 366.5500, -3.1182, 0.0260, -0.7756],
|
|
|
|
|
[-191.5900, 1596.8000, 365.1800, -3.1166, 0.0245, -0.7119],
|
|
|
|
|
[-201.1300, 1606.0000, 363.9800, -3.1152, 0.0229, -0.6517],
|
|
|
|
|
[-209.2300, 1613.7000, 362.9400, -3.1139, 0.0214, -0.5949],
|
|
|
|
|
[-215.8800, 1620.0000, 362.0700, -3.1128, 0.0199, -0.5417],
|
|
|
|
|
[-221.1000, 1625.0000, 361.3700, -3.1119, 0.0184, -0.4920],
|
|
|
|
|
[-224.8700, 1628.6000, 360.8300, -3.1111, 0.0170, -0.4458],
|
|
|
|
|
[-227.2000, 1630.9000, 360.4500, -3.1103, 0.0157, -0.4030],
|
|
|
|
|
[-228.0900, 1631.7000, 360.2500, -3.1098, 0.0145, -0.3638],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1093, 0.0133, -0.3280],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1088, 0.0123, -0.2957],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1085, 0.0113, -0.2669],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1082, 0.0105, -0.2416],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1080, 0.0098, -0.2198],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1078, 0.0091, -0.2015],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1077, 0.0086, -0.1867],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1076, 0.0083, -0.1754],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0080, -0.1675],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0078, -0.1631],
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0078, -0.1622]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Pose_3_4 = [
|
|
|
|
|
[-228.1000, 1631.7000, 360.2000, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 370.9763, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 381.7526, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 392.5289, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 403.3053, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 414.0816, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 424.8579, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 435.6342, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 446.4105, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 457.1868, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 467.9632, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 478.7395, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 489.5158, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 500.2921, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 511.0684, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 521.8447, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 532.6211, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 543.3974, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 554.1737, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0078, -0.1622]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
Pose_4 = [
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0078, -0.1622],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0078, -0.1631],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1075, 0.0080, -0.1675],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1076, 0.0083, -0.1754],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1077, 0.0086, -0.1867],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1078, 0.0091, -0.2015],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1080, 0.0098, -0.2198],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1082, 0.0105, -0.2416],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1085, 0.0113, -0.2669],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1088, 0.0123, -0.2957],
|
|
|
|
|
[-228.1000, 1631.7000, 564.9500, -3.1093, 0.0133, -0.3280],
|
|
|
|
|
[-228.0900, 1631.7000, 564.9500, -3.1098, 0.0145, -0.3638],
|
|
|
|
|
[-227.2000, 1630.9000, 564.8400, -3.1103, 0.0157, -0.4030],
|
|
|
|
|
[-224.8700, 1628.6000, 564.5800, -3.1111, 0.0170, -0.4458],
|
|
|
|
|
[-221.1000, 1625.0000, 564.1400, -3.1119, 0.0184, -0.4920],
|
|
|
|
|
[-215.8800, 1620.0000, 563.5400, -3.1128, 0.0199, -0.5417],
|
|
|
|
|
[-209.2300, 1613.7000, 562.7700, -3.1139, 0.0214, -0.5949],
|
|
|
|
|
[-201.1300, 1606.0000, 561.8400, -3.1152, 0.0229, -0.6517],
|
|
|
|
|
[-191.5900, 1596.8000, 560.7400, -3.1166, 0.0245, -0.7119],
|
|
|
|
|
[-180.6100, 1586.3000, 559.4800, -3.1182, 0.0260, -0.7756],
|
|
|
|
|
[-168.1900, 1574.5000, 558.0500, -3.1200, 0.0275, -0.8428],
|
|
|
|
|
[-154.3400, 1561.3000, 556.4500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-139.9300, 1547.5000, 554.7900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-125.5100, 1533.7000, 553.1300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-111.1000, 1520.0000, 551.4700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-96.6900, 1506.2000, 549.8100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-82.2780, 1492.4000, 548.1500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-67.8660, 1478.7000, 546.4900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-53.4540, 1464.9000, 544.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-39.0420, 1451.1000, 543.1700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-24.6310, 1437.3000, 541.5100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[-10.2190, 1423.6000, 539.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[4.1933, 1409.8000, 538.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[18.6050, 1396.0000, 536.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[33.0170, 1382.3000, 534.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[47.4290, 1368.5000, 533.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[61.8410, 1354.7000, 531.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[76.2530, 1341.0000, 529.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[90.6650, 1327.2000, 528.2400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[105.0800, 1313.4000, 526.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[123.0900, 1296.2000, 524.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[137.5000, 1282.5000, 522.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[151.9100, 1268.7000, 521.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[166.3300, 1254.9000, 519.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[180.7400, 1241.2000, 517.8700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[195.1500, 1227.4000, 516.2100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[209.5600, 1213.6000, 514.5500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[223.9700, 1199.9000, 512.8900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[238.3900, 1186.1000, 511.2300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[252.8000, 1172.3000, 509.5700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[267.2100, 1158.6000, 507.9100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[281.6200, 1144.8000, 506.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[296.0300, 1131.0000, 504.5900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[310.4500, 1117.2000, 502.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[324.8600, 1103.5000, 501.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[339.2700, 1089.7000, 499.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[353.6800, 1076.0000, 497.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[368.0900, 1062.2000, 496.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[382.5000, 1048.4000, 494.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[396.9200, 1034.7000, 492.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[411.3300, 1020.9000, 491.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[425.7400, 1007.1000, 489.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[440.1500, 993.3500, 487.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[454.5600, 979.5800, 486.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[468.9800, 965.8100, 484.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[483.3900, 952.0400, 483.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[497.8000, 938.2800, 481.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[512.2100, 924.5100, 479.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[526.6200, 910.7400, 478.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[541.0400, 896.9800, 476.3700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[555.4500, 883.2100, 474.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[569.8600, 869.4400, 473.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[584.2700, 855.6700, 471.3900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[598.6800, 841.9100, 469.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[613.1000, 828.1400, 468.0800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[627.5100, 814.3700, 466.4200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[641.9200, 800.6000, 464.7600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[656.3300, 786.8400, 463.1000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[670.7400, 773.0700, 461.4400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[685.1500, 759.3000, 459.7800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[699.5700, 745.5300, 458.1200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[713.9800, 731.7700, 456.4600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[728.3900, 718.0000, 454.8000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[742.8000, 704.2300, 453.1400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[757.2200, 690.4600, 451.4800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[771.6300, 676.7000, 449.8200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[786.0400, 662.9300, 448.1600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[800.4500, 649.1600, 446.5000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[814.8600, 635.3900, 444.8400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[829.2700, 621.6300, 443.1800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[843.6900, 607.8600, 441.5200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[858.1000, 594.0900, 439.8600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[872.5100, 580.3200, 438.2000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[886.9200, 566.5600, 436.5400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[901.3300, 552.7900, 434.8800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[915.7500, 539.0200, 433.2200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[930.1600, 525.2500, 431.5600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[944.5700, 511.4900, 429.9000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[958.9800, 497.7200, 428.2500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[973.3900, 483.9500, 426.5800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[987.8000, 470.1800, 424.9300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1002.2000, 456.4200, 423.2700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1016.6000, 442.6500, 421.6100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1031.0000, 428.8800, 419.9500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1045.5000, 415.1100, 418.2900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1059.9000, 401.3500, 416.6300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1074.3000, 387.5800, 414.9700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1088.7000, 373.8100, 413.3100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1103.1000, 360.0500, 411.6500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1117.5000, 346.2800, 409.9900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1131.9000, 332.5100, 408.3300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1146.3000, 318.7400, 406.6700, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1160.8000, 304.9800, 405.0100, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1175.2000, 291.2100, 403.3500, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1189.6000, 277.4400, 401.6900, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1204.0000, 263.6700, 400.0300, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1222.0000, 246.4600, 397.9600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1236.4000, 232.7000, 396.3000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1250.8000, 218.9300, 394.6400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1265.2000, 205.1600, 392.9800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1279.7000, 191.3900, 391.3200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1294.1000, 177.6300, 389.6600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1308.5000, 163.8600, 388.0000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1322.9000, 150.0900, 386.3400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1337.3000, 136.3200, 384.6800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1351.7000, 122.5600, 383.0200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1366.1000, 108.7900, 381.3600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1380.5000, 95.0210, 379.7000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1394.9000, 81.2540, 378.0400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1409.3000, 67.4860, 376.3800, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1423.8000, 53.7190, 374.7200, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1438.2000, 39.9510, 373.0600, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1452.6000, 26.1840, 371.4000, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1467.0000, 12.4160, 369.7400, -3.1205, 0.0279, -0.8601],
|
|
|
|
|
[1481.4000, -1.3082, 368.0900, -3.1212, 0.0284, -0.8834],
|
|
|
|
|
[1494.7000, -14.0430, 366.5500, -3.1225, 0.0293, -0.9300],
|
|
|
|
|
[1506.6000, -25.4010, 365.1800, -3.1239, 0.0302, -0.9765],
|
|
|
|
|
[1517.0000, -35.3830, 363.9800, -3.1253, 0.0309, -1.0231],
|
|
|
|
|
[1526.0000, -43.9870, 362.9400, -3.1268, 0.0317, -1.0696],
|
|
|
|
|
[1533.6000, -51.2150, 362.0700, -3.1282, 0.0323, -1.1162],
|
|
|
|
|
[1539.7000, -57.0660, 361.3700, -3.1298, 0.0329, -1.1628],
|
|
|
|
|
[1544.4000, -61.5410, 360.8300, -3.1313, 0.0334, -1.2093],
|
|
|
|
|
[1547.7000, -64.6380, 360.4500, -3.1329, 0.0339, -1.2559],
|
|
|
|
|
[1549.5000, -66.3590, 360.2500, -3.1345, 0.0342, -1.3025],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1361, 0.0345, -1.3484],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1375, 0.0347, -1.3904],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1388, 0.0349, -1.4276],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1399, 0.0349, -1.4602],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, -3.1409, 0.0350, -1.4882],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1415, 0.0350, -1.5114],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1408, 0.0350, -1.5301],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1403, 0.0350, -1.5440],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1400, 0.0349, -1.5534],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1398, 0.0349, -1.5580],
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1398, 0.0349, -1.5584]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
Pose_4_3 = [
|
|
|
|
|
[1549.9000, -66.7470, 360.2000, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 370.9763, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 381.7526, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 392.5289, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 403.3053, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 414.0816, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 424.8579, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 435.6342, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 446.4105, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 457.1868, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 467.9632, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 478.7395, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 489.5158, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 500.2921, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 511.0684, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 521.8447, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 532.6211, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 543.3974, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 554.1737, 3.1398, 0.0349, -1.5584],
|
|
|
|
|
[1549.9000, -66.7470, 564.9500, 3.1398, 0.0349, -1.5584]
|
|
|
|
|
]
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|