diff --git a/src/main/deploy/choreo/HubLeft.traj b/src/main/deploy/choreo/HubLeft.traj index 694d17c3..45215503 100644 --- a/src/main/deploy/choreo/HubLeft.traj +++ b/src/main/deploy/choreo/HubLeft.traj @@ -4,8 +4,8 @@ "snapshot":{ "waypoints":[ {"x":5.630887031555176, "y":5.732077598571777, "heading":-1.5707963267948966, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.842833042144775, "y":4.093028545379639, "heading":-1.56622998352472, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.61260986328125, "y":5.611176013946533, "heading":-1.5707963267948966, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":5.842833042144775, "y":4.093028545379639, "heading":-1.56622998352472, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.623462200164795, "y":5.721696853637695, "heading":-1.5707963267948966, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -19,8 +19,8 @@ "params":{ "waypoints":[ {"x":{"exp":"5.630887031555176 m", "val":5.630887031555176}, "y":{"exp":"5.732077598571777 m", "val":5.732077598571777}, "heading":{"exp":"-1.5707963267948966 rad", "val":-1.5707963267948966}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.842833042144775 m", "val":5.842833042144775}, "y":{"exp":"4.093028545379639 m", "val":4.093028545379639}, "heading":{"exp":"-1.56622998352472 rad", "val":-1.56622998352472}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.61260986328125 m", "val":5.61260986328125}, "y":{"exp":"5.611176013946533 m", "val":5.611176013946533}, "heading":{"exp":"-1.5707963267948966 rad", "val":-1.5707963267948966}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"5.842833042144775 m", "val":5.842833042144775}, "y":{"exp":"4.093028545379639 m", "val":4.093028545379639}, "heading":{"exp":"-1.56622998352472 rad", "val":-1.56622998352472}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.623462200164795 m", "val":5.623462200164795}, "y":{"exp":"5.721696853637695 m", "val":5.721696853637695}, "heading":{"exp":"-1.5707963267948966 rad", "val":-1.5707963267948966}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -59,83 +59,85 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,1.78254,3.44813], + "waypoints":[0.0,1.78254,3.5561], "samples":[ - {"t":0.0, "x":5.63089, "y":5.73208, "heading":-1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.02853, "ay":-7.92924, "alpha":0.01561, "fx":[16.4342,16.05631,16.39491,16.42934], "fy":[-125.86563,-125.92676,-125.87108,-125.86664]}, - {"t":0.04818, "x":5.63208, "y":5.72288, "heading":-1.5708, "vx":0.04955, "vy":-0.382, "omega":0.00075, "ax":1.03714, "ay":-7.92805, "alpha":-0.00426, "fx":[16.43241,16.61624,16.38695,16.42599], "fy":[-125.8708,-125.83497,-125.877,-125.87189]}, - {"t":0.09635, "x":5.63567, "y":5.69527, "heading":-1.57076, "vx":0.09952, "vy":-0.76395, "omega":0.00055, "ax":0.62056, "ay":-4.72074, "alpha":0.05531, "fx":[9.98635,9.81676,9.80918,9.79478], "fy":[-74.31316,-75.10377,-75.18279,-75.1811]}, - {"t":0.14453, "x":5.64119, "y":5.65299, "heading":-1.57073, "vx":0.12941, "vy":-0.99138, "omega":0.00321, "ax":-0.07108, "ay":-0.00917, "alpha":-0.06683, "fx":[-1.04419,-1.21448,-1.20926,-1.04596], "fy":[0.43593,-1.52695,0.25333,0.2552]}, - {"t":0.19271, "x":5.64734, "y":5.60522, "heading":-1.57058, "vx":0.12599, "vy":-0.99182, "omega":-0.00001, "ax":0.038, "ay":0.00486, "alpha":0.00476, "fx":[0.67325,0.51401,0.51429,0.71144], "fy":[-0.26763,0.313,0.13141,0.13201]}, - {"t":0.24088, "x":5.65345, "y":5.55744, "heading":-1.57058, "vx":0.12782, "vy":-0.99159, "omega":0.00022, "ax":0.0097, "ay":0.00125, "alpha":0.0074, "fx":[0.22301,0.0849,0.08494,0.22344], "fy":[0.21077,-0.21944,0.04394,0.04433]}, - {"t":0.28906, "x":5.65962, "y":5.50967, "heading":-1.57057, "vx":0.12829, "vy":-0.99153, "omega":0.00058, "ax":0.00995, "ay":0.00129, "alpha":0.01145, "fx":[0.21181,0.08135,0.08196,0.25664], "fy":[-0.1602,0.17996,0.0308,0.03133]}, - {"t":0.33724, "x":5.66581, "y":5.4619, "heading":-1.57054, "vx":0.12877, "vy":-0.99147, "omega":0.00113, "ax":-0.01135, "ay":-0.00147, "alpha":0.01004, "fx":[-0.12669,-0.23409,-0.2336,-0.1262], "fy":[0.10585,-0.1481,-0.02584,-0.02529]}, - {"t":0.38541, "x":5.672, "y":5.41413, "heading":-1.57049, "vx":0.12822, "vy":-0.99154, "omega":0.00161, "ax":0.00355, "ay":0.00046, "alpha":0.01294, "fx":[0.1001,0.00113,0.00178,0.12268], "fy":[-0.05975,0.10496,-0.00828,-0.00772]}, - {"t":0.43359, "x":5.67819, "y":5.36637, "heading":-1.57041, "vx":0.12839, "vy":-0.99152, "omega":0.00224, "ax":-0.00521, "ay":-0.00067, "alpha":0.0116, "fx":[-0.0444,-0.12161,-0.12114,-0.04394], "fy":[0.06286,-0.03818,-0.03402,-0.03349]}, - {"t":0.48177, "x":5.68436, "y":5.3186, "heading":-1.5703, "vx":0.12814, "vy":-0.99155, "omega":0.0028, "ax":0.00133, "ay":0.00017, "alpha":0.01181, "fx":[0.05494,-0.01556,-0.01501,0.06003], "fy":[0.00033,0.05716,-0.02353,-0.02305]}, - {"t":0.52994, "x":5.69054, "y":5.27083, "heading":-1.57017, "vx":0.1282, "vy":-0.99154, "omega":0.00337, "ax":-0.001, "ay":-0.00013, "alpha":0.00997, "fx":[0.00979,-0.04195,-0.04159,0.01014], "fy":[0.03867,0.00959,-0.02845,-0.02804]}, - {"t":0.57812, "x":5.69671, "y":5.22306, "heading":-1.57, "vx":0.12816, "vy":-0.99155, "omega":0.00385, "ax":0.00055, "ay":0.00007, "alpha":0.00912, "fx":[0.03273,-0.01457,-0.01418,0.03071], "fy":[0.02071,0.03056,-0.02356,-0.02322]}, - {"t":0.6263, "x":5.70289, "y":5.17529, "heading":-1.56982, "vx":0.12818, "vy":-0.99154, "omega":0.00429, "ax":0.00009, "ay":0.00001, "alpha":0.00726, "fx":[0.01718,-0.0145,-0.01427,0.01741], "fy":[0.02175,0.022,-0.02163,-0.02136]}, - {"t":0.67447, "x":5.70906, "y":5.12752, "heading":-1.56961, "vx":0.12819, "vy":-0.99154, "omega":0.00463, "ax":0.00022, "ay":0.00003, "alpha":0.00611, "fx":[0.01886,-0.01016,-0.00993,0.01551], "fy":[0.02129,0.01559,-0.01762,-0.01742]}, - {"t":0.72265, "x":5.71524, "y":5.07975, "heading":-1.56939, "vx":0.1282, "vy":-0.99154, "omega":0.00493, "ax":0.00002, "ay":0.0, "alpha":0.00428, "fx":[0.0083,-0.00768,-0.00757,0.00841], "fy":[0.01057,0.01747,-0.014,-0.01386]}, - {"t":0.77083, "x":5.72142, "y":5.03198, "heading":-1.56915, "vx":0.1282, "vy":-0.99154, "omega":0.00514, "ax":0.00022, "ay":0.00003, "alpha":0.00313, "fx":[0.01105,-0.00322,-0.00312,0.00909], "fy":[0.01276,0.0072,-0.00913,-0.00905]}, - {"t":0.819, "x":5.72759, "y":4.98421, "heading":-1.5689, "vx":0.12821, "vy":-0.99154, "omega":0.00529, "ax":-0.00026, "ay":-0.00003, "alpha":0.00132, "fx":[-0.00266,-0.0056,-0.00557,-0.00263], "fy":[0.00311,0.00621,-0.00574,-0.0057]}, - {"t":0.86718, "x":5.73377, "y":4.93644, "heading":-1.56865, "vx":0.1282, "vy":-0.99154, "omega":0.00535, "ax":0.0004, "ay":0.00005, "alpha":0.00025, "fx":[0.00685,0.00558,0.00559,0.00735], "fy":[0.0011,0.00169,0.00024,0.00025]}, - {"t":0.91536, "x":5.73995, "y":4.88867, "heading":-1.56839, "vx":0.12822, "vy":-0.99154, "omega":0.00536, "ax":-0.00056, "ay":-0.00007, "alpha":-0.00162, "fx":[-0.01351,-0.00416,-0.00418,-0.01353], "fy":[-0.00322,-0.00678,0.00272,0.0027]}, - {"t":0.96353, "x":5.74612, "y":4.8409, "heading":-1.56813, "vx":0.12819, "vy":-0.99154, "omega":0.00528, "ax":0.00063, "ay":0.00008, "alpha":-0.00265, "fx":[0.00326,0.01517,0.01514,0.00642], "fy":[-0.01045,-0.00387,0.00976,0.00973]}, - {"t":1.01171, "x":5.7523, "y":4.79313, "heading":-1.56788, "vx":0.12822, "vy":-0.99154, "omega":0.00516, "ax":-0.00089, "ay":-0.00011, "alpha":-0.00465, "fx":[-0.02551,-0.00265,-0.0027,-0.02556], "fy":[-0.01099,-0.01822,0.01097,0.01094]}, - {"t":1.05989, "x":5.75848, "y":4.74537, "heading":-1.56763, "vx":0.12818, "vy":-0.99154, "omega":0.00493, "ax":0.00076, "ay":0.0001, "alpha":-0.00569, "fx":[-0.00273,0.02444,0.02441,0.00243], "fy":[-0.01865,-0.01241,0.01868,0.01866]}, - {"t":1.10806, "x":5.76465, "y":4.6976, "heading":-1.56739, "vx":0.12821, "vy":-0.99154, "omega":0.00466, "ax":-0.00112, "ay":-0.00014, "alpha":-0.00777, "fx":[-0.03748,0.00204,0.00198,-0.03754], "fy":[-0.02292,-0.02323,0.01849,0.01848]}, - {"t":1.15624, "x":5.77083, "y":4.64983, "heading":-1.56717, "vx":0.12816, "vy":-0.99155, "omega":0.00428, "ax":0.00067, "ay":0.00009, "alpha":-0.00882, "fx":[-0.01372,0.03259,0.03259,-0.00882], "fy":[-0.01764,-0.02762,0.02539,0.02539]}, - {"t":1.20442, "x":5.777, "y":4.60206, "heading":-1.56696, "vx":0.12819, "vy":-0.99154, "omega":0.00386, "ax":-0.00048, "ay":-0.00006, "alpha":-0.01072, "fx":[-0.03806,0.02299,0.02291,-0.03814], "fy":[-0.0414,-0.0121,0.02478,0.0248]}, - {"t":1.2526, "x":5.78318, "y":4.55429, "heading":-1.56678, "vx":0.12817, "vy":-0.99155, "omega":0.00334, "ax":0.00019, "ay":0.00003, "alpha":-0.01168, "fx":[-0.03218,0.03859,0.03862,-0.03267], "fy":[0.00288,-0.05443,0.02656,0.02659]}, - {"t":1.30077, "x":5.78935, "y":4.50652, "heading":-1.56662, "vx":0.12818, "vy":-0.99154, "omega":0.00278, "ax":0.0028, "ay":0.00036, "alpha":-0.01272, "fx":[0.00023,0.08875,0.08863,0.00012], "fy":[-0.06822,0.03272,0.02923,0.02926]}, - {"t":1.34895, "x":5.79553, "y":4.45875, "heading":-1.56648, "vx":0.12831, "vy":-0.99153, "omega":0.00217, "ax":-0.00148, "ay":-0.00019, "alpha":-0.0131, "fx":[-0.07008,0.03082,0.03084,-0.08561], "fy":[0.06211,-0.10174,0.01372,0.01374]}, - {"t":1.39713, "x":5.80171, "y":4.41098, "heading":-1.56638, "vx":0.12824, "vy":-0.99154, "omega":0.00154, "ax":0.00827, "ay":0.00107, "alpha":-0.01181, "fx":[0.07072,0.19206,0.19188,0.07054], "fy":[-0.11289,0.13786,0.02152,0.02154]}, - {"t":1.4453, "x":5.8079, "y":4.36321, "heading":-1.5663, "vx":0.12864, "vy":-0.99148, "omega":0.00097, "ax":-0.0064, "ay":-0.00083, "alpha":-0.01222, "fx":[-0.16009,-0.02553,-0.02558,-0.19524], "fy":[0.15976,-0.17337,-0.0195,-0.01955]}, - {"t":1.49348, "x":5.81409, "y":4.31545, "heading":-1.56626, "vx":0.12833, "vy":-0.99152, "omega":0.00038, "ax":-0.00945, "ay":-0.00122, "alpha":-0.01061, "fx":[-0.2277,-0.07215,-0.07221,-0.22806], "fy":[-0.20856,0.20281,-0.03585,-0.03593]}, - {"t":1.54166, "x":5.82026, "y":4.26768, "heading":-1.56624, "vx":0.12788, "vy":-0.99158, "omega":-0.00013, "ax":-0.03195, "ay":-0.00409, "alpha":-0.00692, "fx":[-0.5832,-0.4169,-0.41708,-0.61156], "fy":[0.25792,-0.29905,-0.10919,-0.10972]}, - {"t":1.58983, "x":5.82638, "y":4.2199, "heading":-1.56624, "vx":0.12634, "vy":-0.99178, "omega":-0.00047, "ax":0.06265, "ay":0.0081, "alpha":0.05486, "fx":[0.89962,1.0918,1.08599,0.90089], "fy":[-0.41794,1.3803,-0.22302,-0.22524]}, - {"t":1.63801, "x":5.83254, "y":4.17213, "heading":-1.56627, "vx":0.12936, "vy":-0.99139, "omega":0.00218, "ax":-0.62256, "ay":4.7183, "alpha":-0.06207, "fx":[-10.03446,-9.85267,-9.84456,-9.80261], "fy":[74.17536,75.09234,75.17982,75.17811]}, - {"t":1.68619, "x":5.83805, "y":4.12984, "heading":-1.56616, "vx":0.09936, "vy":-0.76408, "omega":-0.00081, "ax":-1.03405, "ay":7.92846, "alpha":0.00466, "fx":[-16.3853,-16.56658,-16.33528,-16.37782], "fy":[125.87432,125.85026,125.88067,125.87509]}, - {"t":1.73436, "x":5.84164, "y":4.10223, "heading":-1.5662, "vx":0.04955, "vy":-0.38211, "omega":-0.00059, "ax":-1.02842, "ay":7.93144, "alpha":0.01224, "fx":[-16.17536,-16.38759,-16.38341,-16.36104], "fy":[125.94593,125.90647,125.90679,125.91045]}, - {"t":1.78254, "x":5.84283, "y":4.09303, "heading":-1.56623, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.19727, "ay":7.90566, "alpha":-0.01731, "fx":[-19.12224,-18.70473,-19.08594,-19.11716], "fy":[125.48974,125.55422,125.49664,125.49211]}, - {"t":1.83153, "x":5.8414, "y":4.10251, "heading":-1.56623, "vx":-0.05865, "vy":0.38728, "omega":-0.00085, "ax":-1.18468, "ay":7.9075, "alpha":-0.00973, "fx":[-19.00496,-18.76627,-18.76295,-18.69618], "fy":[125.51296,125.54083,125.54285,125.55251]}, - {"t":1.88052, "x":5.8371, "y":4.13098, "heading":-1.56627, "vx":-0.11669, "vy":0.77465, "omega":-0.00132, "ax":-0.69323, "ay":4.36286, "alpha":-0.04913, "fx":[-11.038,-11.01018,-10.94393,-11.02984], "fy":[69.40186,68.69251,69.48338,69.47647]}, - {"t":1.9295, "x":5.83055, "y":4.17416, "heading":-1.56634, "vx":-0.15065, "vy":0.98838, "omega":-0.00373, "ax":0.01556, "ay":0.00238, "alpha":0.04595, "fx":[0.25057,0.39599,0.39721,-0.05588], "fy":[1.26001,-0.47597,-0.31455,-0.31835]}, - {"t":1.97849, "x":5.82319, "y":4.22258, "heading":-1.56652, "vx":-0.14988, "vy":0.9885, "omega":-0.00148, "ax":0.00837, "ay":0.00127, "alpha":-0.00278, "fx":[0.07514,0.19086,0.191,0.07478], "fy":[-0.17883,0.29409,-0.01724,-0.0175]}, - {"t":2.02748, "x":5.81586, "y":4.27101, "heading":-1.56659, "vx":-0.14947, "vy":0.98856, "omega":-0.00162, "ax":-0.01178, "ay":-0.00178, "alpha":-0.00924, "fx":[-0.2338,-0.10519,-0.10532,-0.30381], "fy":[0.19638,-0.20117,-0.05419,-0.05436]}, - {"t":2.07647, "x":5.80852, "y":4.31943, "heading":-1.56667, "vx":-0.15005, "vy":0.98847, "omega":-0.00207, "ax":0.00601, "ay":0.00091, "alpha":-0.00451, "fx":[0.04875,0.142,0.14209,0.04872], "fy":[-0.13427,0.20118,-0.00455,-0.0045]}, - {"t":2.12546, "x":5.80118, "y":4.36786, "heading":-1.56677, "vx":-0.14976, "vy":0.98852, "omega":-0.00229, "ax":-0.00739, "ay":-0.00112, "alpha":-0.01, "fx":[-0.15474,-0.057,-0.05684,-0.20047], "fy":[0.1049,-0.13327,-0.02145,-0.02132]}, - {"t":2.17444, "x":5.79383, "y":4.41628, "heading":-1.56688, "vx":-0.15012, "vy":0.98846, "omega":-0.00278, "ax":0.0053, "ay":0.0008, "alpha":-0.00801, "fx":[0.05024,0.11802,0.11813,0.05037], "fy":[-0.07179,0.07839,0.02214,0.02236]}, - {"t":2.22343, "x":5.78649, "y":4.4647, "heading":-1.56702, "vx":-0.14986, "vy":0.9885, "omega":-0.00317, "ax":-0.0026, "ay":-0.00039, "alpha":-0.01007, "fx":[-0.07075,-0.00328,-0.003,-0.08818], "fy":[0.02305,-0.06759,0.00962,0.00987]}, - {"t":2.27242, "x":5.77914, "y":4.51313, "heading":-1.56718, "vx":-0.14999, "vy":0.98848, "omega":-0.00367, "ax":0.00211, "ay":0.00032, "alpha":-0.00781, "fx":[0.01079,0.05593,0.05611,0.01098], "fy":[-0.0381,0.01136,0.02339,0.02365]}, - {"t":2.32141, "x":5.7718, "y":4.56155, "heading":-1.56736, "vx":-0.14988, "vy":0.9885, "omega":-0.00405, "ax":-0.00073, "ay":-0.00011, "alpha":-0.00746, "fx":[-0.03154,0.01006,0.01036,-0.03542], "fy":[-0.00634,-0.03207,0.01555,0.01581]}, - {"t":2.37039, "x":5.76445, "y":4.60998, "heading":-1.56755, "vx":-0.14992, "vy":0.98849, "omega":-0.00441, "ax":0.00051, "ay":0.00008, "alpha":-0.00557, "fx":[-0.00581,0.02177,0.02195,-0.00562], "fy":[-0.0185,-0.00944,0.0163,0.01654]}, - {"t":2.41938, "x":5.75711, "y":4.6584, "heading":-1.56777, "vx":-0.14989, "vy":0.9885, "omega":-0.00469, "ax":-0.00026, "ay":-0.00004, "alpha":-0.00412, "fx":[-0.01463,0.00603,0.00628,-0.01396], "fy":[-0.01055,-0.01314,0.0105,0.01072]}, - {"t":2.46837, "x":5.74977, "y":4.70683, "heading":-1.568, "vx":-0.14991, "vy":0.9885, "omega":-0.00489, "ax":0.00016, "ay":0.00002, "alpha":-0.00273, "fx":[-0.0048,0.00975,0.00988,-0.00466], "fy":[-0.00592,-0.00734,0.00731,0.00749]}, - {"t":2.51736, "x":5.74242, "y":4.75525, "heading":-1.56824, "vx":-0.1499, "vy":0.9885, "omega":-0.00502, "ax":-0.0003, "ay":-0.00004, "alpha":-0.00068, "fx":[-0.00658,-0.00312,-0.00295,-0.00608], "fy":[-0.00232,-0.00287,0.0011,0.00125]}, - {"t":2.56635, "x":5.73508, "y":4.80368, "heading":-1.56849, "vx":-0.14991, "vy":0.98849, "omega":-0.00506, "ax":0.00037, "ay":0.00006, "alpha":0.00022, "fx":[0.00365,0.00815,0.00822,0.00373], "fy":[0.00285,0.00501,-0.00219,-0.00208]}, - {"t":2.61533, "x":5.72774, "y":4.8521, "heading":-1.56873, "vx":-0.1499, "vy":0.9885, "omega":-0.00505, "ax":-0.00054, "ay":-0.00008, "alpha":0.00271, "fx":[-0.00228,-0.0141,-0.014,-0.00397], "fy":[0.01061,0.00371,-0.00981,-0.00972]}, - {"t":2.66432, "x":5.72039, "y":4.90052, "heading":-1.56898, "vx":-0.14992, "vy":0.98849, "omega":-0.00491, "ax":0.00082, "ay":0.00012, "alpha":0.00315, "fx":[0.01521,0.01072,0.01075,0.01525], "fy":[0.01078,0.02005,-0.01151,-0.01144]}, - {"t":2.71331, "x":5.71305, "y":4.94895, "heading":-1.56922, "vx":-0.14988, "vy":0.9885, "omega":-0.00476, "ax":-0.00079, "ay":-0.00012, "alpha":0.00606, "fx":[0.00212,-0.02509,-0.02503,-0.00196], "fy":[0.023,0.01055,-0.02059,-0.02054]}, - {"t":2.7623, "x":5.70571, "y":4.99737, "heading":-1.56945, "vx":-0.14992, "vy":0.98849, "omega":-0.00446, "ax":0.00124, "ay":0.00019, "alpha":0.00601, "fx":[0.02697,0.0125,0.01252,0.02699], "fy":[0.02078,0.03135,-0.0201,-0.02005]}, - {"t":2.81129, "x":5.69836, "y":5.0458, "heading":-1.56967, "vx":-0.14986, "vy":0.9885, "omega":-0.00417, "ax":-0.00087, "ay":-0.00013, "alpha":0.00936, "fx":[0.00972,-0.03502,-0.03497,0.00511], "fy":[0.02853,0.02183,-0.02939,-0.02934]}, - {"t":2.86027, "x":5.69102, "y":5.09422, "heading":-1.56988, "vx":-0.1499, "vy":0.9885, "omega":-0.00371, "ax":0.00089, "ay":0.00013, "alpha":0.00852, "fx":[0.02771,0.00044,0.00048,0.02775], "fy":[0.03534,0.02845,-0.02765,-0.02759]}, - {"t":2.90926, "x":5.68368, "y":5.14265, "heading":-1.57006, "vx":-0.14986, "vy":0.9885, "omega":-0.00329, "ax":-0.00068, "ay":-0.0001, "alpha":0.01225, "fx":[0.02213,-0.04398,-0.04388,0.02224], "fy":[0.016,0.04288,-0.03278,-0.03269]}, - {"t":2.95825, "x":5.67634, "y":5.19107, "heading":-1.57022, "vx":-0.14989, "vy":0.9885, "omega":-0.00269, "ax":-0.00205, "ay":-0.00031, "alpha":0.00991, "fx":[-0.01046,-0.05468,-0.05459,-0.01037], "fy":[0.05596,-0.00747,-0.03417,-0.03406]}, - {"t":3.00724, "x":5.66899, "y":5.2395, "heading":-1.57035, "vx":-0.14999, "vy":0.98848, "omega":-0.00221, "ax":0.00043, "ay":0.00007, "alpha":0.01375, "fx":[0.04904,-0.04302,-0.04285,0.06407], "fy":[-0.03273,0.08248,-0.02288,-0.02273]}, - {"t":3.05623, "x":5.66164, "y":5.28792, "heading":-1.57046, "vx":-0.14997, "vy":0.98849, "omega":-0.00153, "ax":-0.00772, "ay":-0.00117, "alpha":0.00836, "fx":[-0.09015,-0.15529,-0.15512,-0.09], "fy":[0.09096,-0.10334,-0.03115,-0.03098]}, - {"t":3.10521, "x":5.65429, "y":5.33634, "heading":-1.57053, "vx":-0.15035, "vy":0.98843, "omega":-0.00112, "ax":0.00602, "ay":0.00091, "alpha":0.01193, "fx":[0.14606,0.02496,0.0252,0.18614], "fy":[-0.13352,0.15617,0.01762,0.01783]}, - {"t":3.1542, "x":5.64693, "y":5.38476, "heading":-1.57059, "vx":-0.15005, "vy":0.98847, "omega":-0.00054, "ax":0.00789, "ay":0.0012, "alpha":0.0028, "fx":[0.16842,0.0819,0.08191,0.16864], "fy":[0.19808,-0.20841,0.04303,0.04323]}, - {"t":3.20319, "x":5.63959, "y":5.43319, "heading":-1.57062, "vx":-0.14967, "vy":0.98853, "omega":-0.0004, "ax":0.03477, "ay":0.00523, "alpha":0.00366, "fx":[0.61469,0.46673,0.46689,0.6595], "fy":[-0.25537,0.3086,0.13932,0.13978]}, - {"t":3.25218, "x":5.6323, "y":5.48162, "heading":-1.57064, "vx":-0.14796, "vy":0.98879, "omega":-0.00022, "ax":-0.06219, "ay":-0.00942, "alpha":-0.05149, "fx":[-0.93331,-1.0433,-1.03784,-0.93464], "fy":[0.32172,-1.21798,0.14832,0.14979]}, - {"t":3.30117, "x":5.62498, "y":5.53005, "heading":-1.57065, "vx":-0.15101, "vy":0.98833, "omega":-0.00274, "ax":0.67291, "ay":-4.3638, "alpha":0.05545, "fx":[10.82246,10.66174,10.65573,10.5921], "fy":[-68.61042,-69.44652,-69.52843,-69.52895]}, - {"t":3.35015, "x":5.61839, "y":5.57323, "heading":-1.57078, "vx":-0.11805, "vy":0.77455, "omega":-0.00003, "ax":1.20803, "ay":-7.90396, "alpha":-0.00513, "fx":[19.14249,19.31911,19.11092,19.14092], "fy":[-125.48488,-125.46362,-125.49035,-125.48585]}, - {"t":3.39914, "x":5.61405, "y":5.60169, "heading":-1.57078, "vx":-0.05887, "vy":0.38735, "omega":-0.00028, "ax":1.20168, "ay":-7.90711, "alpha":0.0057, "fx":[19.11351,19.01621,19.07151,19.10874], "fy":[-125.52522,-125.54019,-125.53249,-125.52696]}, - {"t":3.44813, "x":5.61261, "y":5.61118, "heading":-1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":5.63089, "y":5.73208, "heading":-1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.02865, "ay":-7.92923, "alpha":0.02157, "fx":[16.47387,15.95161,16.42832,16.46829], "fy":[-125.86115,-125.93791,-125.86762,-125.86247]}, + {"t":0.04818, "x":5.63208, "y":5.72288, "heading":-1.5708, "vx":0.04956, "vy":-0.382, "omega":0.00104, "ax":1.03651, "ay":-7.92814, "alpha":-0.00707, "fx":[16.40512,16.66917,16.34983,16.39729], "fy":[-125.87314,-125.83142,-125.8808,-125.87455]}, + {"t":0.09635, "x":5.63567, "y":5.69527, "heading":-1.57075, "vx":0.09949, "vy":-0.76396, "omega":0.0007, "ax":0.62187, "ay":-4.72057, "alpha":0.06078, "fx":[10.00784,9.84018,9.83276,9.80955], "fy":[-74.22557,-75.12769,-75.2093,-75.20736]}, + {"t":0.14453, "x":5.64119, "y":5.65299, "heading":-1.57071, "vx":0.12945, "vy":-0.99138, "omega":0.00363, "ax":-0.07354, "ay":-0.00949, "alpha":-0.07043, "fx":[-1.08216,-1.2546,-1.24911,-1.08402], "fy":[0.45105,-1.58907,0.26678,0.26875]}, + {"t":0.19271, "x":5.64734, "y":5.60522, "heading":-1.57054, "vx":0.12591, "vy":-0.99183, "omega":0.00023, "ax":0.0392, "ay":0.00501, "alpha":0.00333, "fx":[0.69278,0.53166,0.53195,0.73314], "fy":[-0.29223,0.32583,0.14211,0.14274]}, + {"t":0.24088, "x":5.65345, "y":5.55744, "heading":-1.57053, "vx":0.1278, "vy":-0.99159, "omega":0.00039, "ax":0.01093, "ay":0.00141, "alpha":0.00675, "fx":[0.24317,0.10357,0.10362,0.24362], "fy":[0.21912,-0.23045,0.05028,0.05068]}, + {"t":0.28906, "x":5.65962, "y":5.50967, "heading":-1.57051, "vx":0.12832, "vy":-0.99153, "omega":0.00072, "ax":0.00986, "ay":0.00128, "alpha":0.01109, "fx":[0.21083,0.07882,0.07946,0.25696], "fy":[-0.17028,0.18425,0.03332,0.03388]}, + {"t":0.33724, "x":5.66581, "y":5.4619, "heading":-1.57047, "vx":0.1288, "vy":-0.99146, "omega":0.00125, "ax":-0.01172, "ay":-0.00152, "alpha":0.00978, "fx":[-0.13203,-0.24046,-0.23994,-0.13152], "fy":[0.10831,-0.15556,-0.02488,-0.0243]}, + {"t":0.38541, "x":5.672, "y":5.41413, "heading":-1.57041, "vx":0.12823, "vy":-0.99154, "omega":0.00172, "ax":0.00339, "ay":0.00044, "alpha":0.01281, "fx":[0.09781,-0.00214,-0.00146,0.12098], "fy":[-0.06471,0.10689,-0.00746,-0.00687]}, + {"t":0.43359, "x":5.67819, "y":5.36637, "heading":-1.57033, "vx":0.1284, "vy":-0.99152, "omega":0.00234, "ax":-0.00536, "ay":-0.00069, "alpha":0.01152, "fx":[-0.04646,-0.12408,-0.12359,-0.04598], "fy":[0.06395,-0.04109,-0.03371,-0.03316]}, + {"t":0.48177, "x":5.68436, "y":5.3186, "heading":-1.57022, "vx":0.12814, "vy":-0.99155, "omega":0.0029, "ax":0.00121, "ay":0.00016, "alpha":0.01176, "fx":[0.05326,-0.01759,-0.01701,0.05827], "fy":[-0.00147,0.05769,-0.02339,-0.02289]}, + {"t":0.52994, "x":5.69054, "y":5.27083, "heading":-1.57008, "vx":0.1282, "vy":-0.99154, "omega":0.00346, "ax":-0.00092, "ay":-0.00012, "alpha":0.0099, "fx":[0.01101,-0.04056,-0.04019,0.01138], "fy":[0.03921,0.00882,-0.028,-0.02757]}, + {"t":0.57812, "x":5.69671, "y":5.22306, "heading":-1.56991, "vx":0.12815, "vy":-0.99155, "omega":0.00394, "ax":0.00046, "ay":0.00006, "alpha":0.00905, "fx":[0.0313,-0.01578,-0.01537,0.02895], "fy":[0.02015,0.03034,-0.02354,-0.02319]}, + {"t":0.6263, "x":5.70289, "y":5.17529, "heading":-1.56972, "vx":0.12818, "vy":-0.99154, "omega":0.00438, "ax":0.00023, "ay":0.00003, "alpha":0.00714, "fx":[0.01896,-0.01205,-0.01181,0.0192], "fy":[0.02179,0.02192,-0.02107,-0.02079]}, + {"t":0.67447, "x":5.70906, "y":5.12752, "heading":-1.56951, "vx":0.12819, "vy":-0.99154, "omega":0.00472, "ax":0.00016, "ay":0.00002, "alpha":0.00597, "fx":[0.0175,-0.01082,-0.01058,0.01385], "fy":[0.02101,0.01496,-0.01745,-0.01724]}, + {"t":0.72265, "x":5.71524, "y":5.07975, "heading":-1.56928, "vx":0.12819, "vy":-0.99154, "omega":0.00501, "ax":0.00012, "ay":0.00002, "alpha":0.00409, "fx":[0.0093,-0.00558,-0.00546,0.00942], "fy":[0.0102,0.01734,-0.01334,-0.0132]}, + {"t":0.77083, "x":5.72142, "y":5.03198, "heading":-1.56904, "vx":0.1282, "vy":-0.99154, "omega":0.0052, "ax":0.00018, "ay":0.00002, "alpha":0.00292, "fx":[0.00988,-0.00328,-0.00318,0.00783], "fy":[0.01232,0.00639,-0.00867,-0.00859]}, + {"t":0.819, "x":5.72759, "y":4.98421, "heading":-1.56879, "vx":0.12821, "vy":-0.99154, "omega":0.00534, "ax":-0.00022, "ay":-0.00003, "alpha":0.00105, "fx":[-0.0028,-0.00428,-0.00425,-0.00277], "fy":[0.00238,0.00571,-0.00497,-0.00494]}, + {"t":0.86718, "x":5.73377, "y":4.93644, "heading":-1.56853, "vx":0.1282, "vy":-0.99154, "omega":0.0054, "ax":0.0004, "ay":0.00005, "alpha":-0.00004, "fx":[0.00602,0.00625,0.00626,0.0067], "fy":[0.00035,0.00079,0.00106,0.00106]}, + {"t":0.91536, "x":5.73995, "y":4.88867, "heading":-1.56827, "vx":0.12822, "vy":-0.99154, "omega":0.00539, "ax":-0.00059, "ay":-0.00008, "alpha":-0.00198, "fx":[-0.0149,-0.00372,-0.00375,-0.01493], "fy":[-0.00427,-0.00774,0.0036,0.00358]}, + {"t":0.96353, "x":5.74612, "y":4.8409, "heading":-1.56801, "vx":0.12819, "vy":-0.99154, "omega":0.0053, "ax":0.00067, "ay":0.00009, "alpha":-0.00302, "fx":[0.0028,0.0166,0.01657,0.00645], "fy":[-0.01149,-0.00486,0.01094,0.0109]}, + {"t":1.01171, "x":5.7523, "y":4.79313, "heading":-1.56776, "vx":0.12822, "vy":-0.99154, "omega":0.00515, "ax":-0.00099, "ay":-0.00013, "alpha":-0.00509, "fx":[-0.02819,-0.0031,-0.00316,-0.02825], "fy":[-0.01242,-0.01956,0.01196,0.01192]}, + {"t":1.05989, "x":5.75848, "y":4.74537, "heading":-1.56751, "vx":0.12817, "vy":-0.99154, "omega":0.00491, "ax":0.00084, "ay":0.00011, "alpha":-0.00614, "fx":[-0.00289,0.02661,0.02658,0.00302], "fy":[-0.01982,-0.0136,0.02017,0.02014]}, + {"t":1.10806, "x":5.76465, "y":4.6976, "heading":-1.56727, "vx":0.12821, "vy":-0.99154, "omega":0.00461, "ax":-0.00127, "ay":-0.00016, "alpha":-0.00829, "fx":[-0.04124,0.00098,0.00091,-0.04131], "fy":[-0.02483,-0.02465,0.01954,0.01952]}, + {"t":1.15624, "x":5.77083, "y":4.64983, "heading":-1.56705, "vx":0.12815, "vy":-0.99155, "omega":0.00421, "ax":0.00078, "ay":0.0001, "alpha":-0.00933, "fx":[-0.01368,0.0355,0.03549,-0.00787], "fy":[-0.01852,-0.02922,0.02706,0.02706]}, + {"t":1.20442, "x":5.777, "y":4.60206, "heading":-1.56685, "vx":0.12819, "vy":-0.99154, "omega":0.00376, "ax":-0.00061, "ay":-0.00008, "alpha":-0.0113, "fx":[-0.04182,0.0225,0.02242,-0.0419], "fy":[-0.04392,-0.01288,0.02588,0.0259]}, + {"t":1.2526, "x":5.78318, "y":4.55429, "heading":-1.56667, "vx":0.12816, "vy":-0.99155, "omega":0.00322, "ax":0.00035, "ay":0.00004, "alpha":-0.01222, "fx":[-0.03172,0.04254,0.04257,-0.0314], "fy":[0.00326,-0.0568,0.02818,0.02821]}, + {"t":1.30077, "x":5.78935, "y":4.50652, "heading":-1.56651, "vx":0.12818, "vy":-0.99154, "omega":0.00263, "ax":0.00285, "ay":0.00037, "alpha":-0.01329, "fx":[-0.0009,0.09158,0.09145,-0.00101], "fy":[-0.07143,0.03402,0.0304,0.03043]}, + {"t":1.34895, "x":5.79553, "y":4.45875, "heading":-1.56638, "vx":0.12832, "vy":-0.99153, "omega":0.00199, "ax":-0.00126, "ay":-0.00016, "alpha":-0.01358, "fx":[-0.06873,0.03635,0.03639,-0.0839], "fy":[0.06559,-0.10548,0.01476,0.01479]}, + {"t":1.39713, "x":5.80171, "y":4.41098, "heading":-1.56629, "vx":0.12825, "vy":-0.99153, "omega":0.00134, "ax":0.00858, "ay":0.00111, "alpha":-0.01222, "fx":[0.0733,0.19931,0.19912,0.07311], "fy":[-0.11744,0.1437,0.02215,0.02217]}, + {"t":1.4453, "x":5.8079, "y":4.36321, "heading":-1.56622, "vx":0.12867, "vy":-0.99148, "omega":0.00075, "ax":-0.00619, "ay":-0.0008, "alpha":-0.01248, "fx":[-0.15906,-0.01966,-0.01971,-0.19436], "fy":[0.16831,-0.17933,-0.01992,-0.01997]}, + {"t":1.49348, "x":5.81409, "y":4.31545, "heading":-1.56619, "vx":0.12837, "vy":-0.99152, "omega":0.00015, "ax":-0.01048, "ay":-0.00135, "alpha":-0.01071, "fx":[-0.24675,-0.08594,-0.08599,-0.24712], "fy":[-0.21832,0.21199,-0.03982,-0.03989]}, + {"t":1.54166, "x":5.82026, "y":4.26768, "heading":-1.56618, "vx":0.12786, "vy":-0.99158, "omega":-0.00037, "ax":-0.03287, "ay":-0.00421, "alpha":-0.00624, "fx":[-0.60031,-0.42876,-0.42893,-0.6291], "fy":[0.27898,-0.31252,-0.11668,-0.11722]}, + {"t":1.58983, "x":5.82639, "y":4.2199, "heading":-1.5662, "vx":0.12628, "vy":-0.99179, "omega":-0.00067, "ax":0.06454, "ay":0.00834, "alpha":0.05749, "fx":[0.92667,1.12487,1.11879,0.92802], "fy":[-0.43521,1.43634,-0.23464,-0.23695]}, + {"t":1.63801, "x":5.83254, "y":4.17213, "heading":-1.56623, "vx":0.12939, "vy":-0.99139, "omega":0.0021, "ax":-0.62396, "ay":4.71811, "alpha":-0.0684, "fx":[-10.05918,-9.87685,-9.86891,-9.8183], "fy":[74.08116,75.11543,75.20981,75.2076]}, + {"t":1.68619, "x":5.83805, "y":4.12984, "heading":-1.56613, "vx":0.09933, "vy":-0.76408, "omega":-0.0012, "ax":-1.03338, "ay":7.92855, "alpha":0.007, "fx":[-16.35934,-16.61906,-16.29458,-16.34953], "fy":[125.87767,125.84346,125.88601,125.87873]}, + {"t":1.73436, "x":5.84164, "y":4.10223, "heading":-1.56619, "vx":0.04955, "vy":-0.38211, "omega":-0.00086, "ax":-1.02841, "ay":7.93144, "alpha":0.01785, "fx":[-16.11371,-16.41825,-16.41294,-16.3624], "fy":[125.95147,125.90343,125.90387,125.91088]}, + {"t":1.78254, "x":5.84283, "y":4.09303, "heading":-1.56623, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-1.06509, "ay":7.92459, "alpha":-0.02155, "fx":[-17.05105,-16.51744,-17.02072,-17.0472], "fy":[125.78766,125.86487,125.79294,125.78953]}, + {"t":1.8318, "x":5.84154, "y":4.10265, "heading":-1.56623, "vx":-0.05247, "vy":0.39041, "omega":-0.00106, "ax":-1.05704, "ay":7.92561, "alpha":-0.01013, "fx":[-17.00989,-16.73667,-16.73434,-16.64407], "fy":[125.80198,125.82772,125.8293,125.8405]}, + {"t":1.88107, "x":5.83767, "y":4.1315, "heading":-1.56628, "vx":-0.10455, "vy":0.78087, "omega":-0.00156, "ax":-0.60103, "ay":4.2603, "alpha":-0.04919, "fx":[-9.57335,-9.53983,-9.48727,-9.56651], "fy":[67.78376,67.05325,67.85528,67.84907]}, + {"t":1.93034, "x":5.83179, "y":4.17514, "heading":-1.56636, "vx":-0.13416, "vy":0.99076, "omega":-0.00398, "ax":0.01299, "ay":0.00177, "alpha":0.0475, "fx":[0.20455,0.3418,0.34285,-0.06425], "fy":[1.22785,-0.4717,-0.32025,-0.32357]}, + {"t":1.9796, "x":5.8252, "y":4.22395, "heading":-1.56656, "vx":-0.13352, "vy":0.99084, "omega":-0.00164, "ax":0.00854, "ay":0.00115, "alpha":0.00021, "fx":[0.08039,0.19074,0.19092,0.08006], "fy":[-0.18408,0.32014,-0.03145,-0.03167]}, + {"t":2.02887, "x":5.81863, "y":4.27277, "heading":-1.56664, "vx":-0.1331, "vy":0.9909, "omega":-0.00163, "ax":-0.01039, "ay":-0.0014, "alpha":-0.00643, "fx":[-0.20901,-0.08712,-0.0872,-0.27624], "fy":[0.22549,-0.19756,-0.05829,-0.05841]}, + {"t":2.07813, "x":5.81206, "y":4.32158, "heading":-1.56672, "vx":-0.13361, "vy":0.99083, "omega":-0.00195, "ax":0.00595, "ay":0.0008, "alpha":-0.0026, "fx":[0.04986,0.13888,0.13901,0.04986], "fy":[-0.13686,0.21535,-0.01386,-0.01377]}, + {"t":2.1274, "x":5.80549, "y":4.3704, "heading":-1.56681, "vx":-0.13332, "vy":0.99087, "omega":-0.00208, "ax":-0.00647, "ay":-0.00087, "alpha":-0.00833, "fx":[-0.13838,-0.04573,-0.04552,-0.18115], "fy":[0.11902,-0.12884,-0.02285,-0.02266]}, + {"t":2.17666, "x":5.79891, "y":4.41921, "heading":-1.56692, "vx":-0.13363, "vy":0.99083, "omega":-0.00249, "ax":0.00456, "ay":0.00061, "alpha":-0.00698, "fx":[0.04018,0.10431,0.10446,0.04035], "fy":[-0.0732,0.08066,0.01563,0.0159]}, + {"t":2.22593, "x":5.79233, "y":4.46803, "heading":-1.56704, "vx":-0.13341, "vy":0.99086, "omega":-0.00283, "ax":-0.00216, "ay":-0.00029, "alpha":-0.00922, "fx":[-0.06231,0.00143,0.00178,-0.0782], "fy":[0.02718,-0.06396,0.00899,0.0093]}, + {"t":2.2752, "x":5.78576, "y":4.51684, "heading":-1.56718, "vx":-0.13352, "vy":0.99084, "omega":-0.00329, "ax":0.00155, "ay":0.00021, "alpha":-0.00725, "fx":[0.00341,0.04549,0.04573,0.00365], "fy":[-0.03778,0.01026,0.02022,0.02054]}, + {"t":2.32446, "x":5.77918, "y":4.56565, "heading":-1.56734, "vx":-0.13344, "vy":0.99085, "omega":-0.00364, "ax":-0.00048, "ay":-0.00006, "alpha":-0.00714, "fx":[-0.02663,0.0128,0.01317,-0.02974], "fy":[-0.00659,-0.02935,0.01577,0.01609]}, + {"t":2.37373, "x":5.77261, "y":4.61447, "heading":-1.56752, "vx":-0.13346, "vy":0.99085, "omega":-0.004, "ax":0.00019, "ay":0.00003, "alpha":-0.00543, "fx":[-0.00979,0.01564,0.01588,-0.00955], "fy":[-0.01758,-0.01249,0.01571,0.01601]}, + {"t":2.42299, "x":5.76603, "y":4.66328, "heading":-1.56772, "vx":-0.13345, "vy":0.99085, "omega":-0.00426, "ax":-0.00003, "ay":0.0, "alpha":-0.00429, "fx":[-0.01111,0.00932,0.00963,-0.00969], "fy":[-0.01352,-0.01126,0.01213,0.0124]}, + {"t":2.47226, "x":5.75946, "y":4.7121, "heading":-1.56793, "vx":-0.13346, "vy":0.99085, "omega":-0.00447, "ax":-0.00007, "ay":-0.00001, "alpha":-0.00305, "fx":[-0.00812,0.00569,0.00587,-0.00794], "fy":[-0.00566,-0.01242,0.00861,0.00885]}, + {"t":2.52152, "x":5.75288, "y":4.76091, "heading":-1.56815, "vx":-0.13346, "vy":0.99085, "omega":-0.00462, "ax":-0.00004, "ay":-0.00001, "alpha":-0.0014, "fx":[-0.00397,0.00181,0.00204,-0.00225], "fy":[-0.0073,-0.00215,0.00446,0.00466]}, + {"t":2.57079, "x":5.74631, "y":4.80973, "heading":-1.56837, "vx":-0.13346, "vy":0.99085, "omega":-0.00469, "ax":0.00008, "ay":0.00001, "alpha":-0.00064, "fx":[-0.00165,0.00421,0.00433,-0.00153], "fy":[0.00131,-0.00206,0.00066,0.00082]}, + {"t":2.62005, "x":5.73973, "y":4.85854, "heading":-1.56861, "vx":-0.13346, "vy":0.99085, "omega":-0.00472, "ax":-0.00025, "ay":-0.00003, "alpha":0.00136, "fx":[-0.00095,-0.00711,-0.00697,-0.00085], "fy":[0.00432,0.00251,-0.00455,-0.00442]}, + {"t":2.66932, "x":5.73316, "y":4.90736, "heading":-1.56884, "vx":-0.13347, "vy":0.99085, "omega":-0.00466, "ax":0.00039, "ay":0.00005, "alpha":0.00168, "fx":[0.00619,0.00605,0.00611,0.00625], "fy":[0.0061,0.01191,-0.0074,-0.00731]}, + {"t":2.71859, "x":5.72658, "y":4.95617, "heading":-1.56907, "vx":-0.13345, "vy":0.99085, "omega":-0.00457, "ax":-0.00052, "ay":-0.00007, "alpha":0.00403, "fx":[0.00079,-0.01642,-0.01634,-0.00137], "fy":[0.01726,0.00586,-0.01383,-0.01377]}, + {"t":2.76785, "x":5.72001, "y":5.00499, "heading":-1.56929, "vx":-0.13348, "vy":0.99085, "omega":-0.00438, "ax":0.00078, "ay":0.00011, "alpha":0.00398, "fx":[0.01542,0.0094,0.00943,0.01544], "fy":[0.01122,0.0258,-0.01519,-0.01514]}, + {"t":2.81712, "x":5.71343, "y":5.0538, "heading":-1.56951, "vx":-0.13344, "vy":0.99085, "omega":-0.00418, "ax":-0.00075, "ay":-0.0001, "alpha":0.00674, "fx":[0.00375,-0.02544,-0.02539,-0.00031], "fy":[0.02831,0.01069,-0.02272,-0.02268]}, + {"t":2.86638, "x":5.70686, "y":5.10262, "heading":-1.56971, "vx":-0.13347, "vy":0.99085, "omega":-0.00385, "ax":0.00115, "ay":0.00015, "alpha":0.00626, "fx":[0.025,0.01144,0.01145,0.02501], "fy":[0.0192,0.03512,-0.02227,-0.02223]}, + {"t":2.91565, "x":5.70028, "y":5.15143, "heading":-1.5699, "vx":-0.13342, "vy":0.99086, "omega":-0.00354, "ax":-0.0008, "ay":-0.00011, "alpha":0.00945, "fx":[0.01028,-0.03365,-0.03359,0.00623], "fy":[0.03193,0.02058,-0.02969,-0.02965]}, + {"t":2.96491, "x":5.69371, "y":5.20025, "heading":-1.57008, "vx":-0.13346, "vy":0.99085, "omega":-0.00307, "ax":0.00084, "ay":0.00011, "alpha":0.00825, "fx":[0.02553,0.00109,0.00112,0.02557], "fy":[0.03274,0.0302,-0.02791,-0.02785]}, + {"t":3.01418, "x":5.68714, "y":5.24906, "heading":-1.57023, "vx":-0.13342, "vy":0.99086, "omega":-0.00267, "ax":-0.0006, "ay":-0.00008, "alpha":0.01177, "fx":[0.02172,-0.04117,-0.04107,0.02265], "fy":[0.01667,0.04071,-0.03128,-0.03119]}, + {"t":3.06344, "x":5.68056, "y":5.29788, "heading":-1.57036, "vx":-0.13345, "vy":0.99085, "omega":-0.00209, "ax":-0.00177, "ay":-0.00024, "alpha":0.0091, "fx":[-0.00822,-0.04799,-0.0479,-0.00813], "fy":[0.0542,-0.00742,-0.03101,-0.03089]}, + {"t":3.11271, "x":5.67399, "y":5.34669, "heading":-1.57046, "vx":-0.13353, "vy":0.99084, "omega":-0.00164, "ax":0.00045, "ay":0.00006, "alpha":0.01259, "fx":[0.04654,-0.04013,-0.03996,0.062], "fy":[-0.03686,0.07964,-0.01955,-0.01939]}, + {"t":3.16198, "x":5.66741, "y":5.39551, "heading":-1.57055, "vx":-0.13351, "vy":0.99084, "omega":-0.00102, "ax":-0.00702, "ay":-0.00095, "alpha":0.00683, "fx":[-0.08192,-0.14109,-0.14092,-0.08176], "fy":[0.09203,-0.10697,-0.02269,-0.0225]}, + {"t":3.21124, "x":5.66082, "y":5.44432, "heading":-1.5706, "vx":-0.13386, "vy":0.9908, "omega":-0.00068, "ax":0.00536, "ay":0.00072, "alpha":0.00974, "fx":[0.13174,0.01827,0.01852,0.17196], "fy":[-0.15008,0.15181,0.022,0.02222]}, + {"t":3.26051, "x":5.65423, "y":5.49313, "heading":-1.57063, "vx":-0.13359, "vy":0.99083, "omega":-0.0002, "ax":0.00631, "ay":0.00085, "alpha":0.0003, "fx":[0.13943,0.06067,0.06069,0.13964], "fy":[0.19123,-0.23028,0.04639,0.04659]}, + {"t":3.30977, "x":5.64766, "y":5.54195, "heading":-1.57064, "vx":-0.13328, "vy":0.99087, "omega":-0.00019, "ax":0.03016, "ay":0.00403, "alpha":0.00074, "fx":[0.53603,0.39847,0.39865,0.58226], "fy":[-0.29259,0.28764,0.13035,0.13078]}, + {"t":3.35904, "x":5.64113, "y":5.59077, "heading":-1.57065, "vx":-0.1318, "vy":0.99107, "omega":-0.00015, "ax":-0.05183, "ay":-0.00697, "alpha":-0.04963, "fx":[-0.77445,-0.87326,-0.86821,-0.77558], "fy":[0.33275,-1.12366,0.17333,0.17464]}, + {"t":3.4083, "x":5.63457, "y":5.63959, "heading":-1.57066, "vx":-0.13435, "vy":0.99073, "omega":-0.0026, "ax":0.58207, "ay":-4.26075, "alpha":0.05376, "fx":[9.35739,9.21881,9.21407,9.1729], "fy":[-66.98937,-67.81217,-67.88472,-67.88393]}, + {"t":3.45757, "x":5.62866, "y":5.68323, "heading":-1.57078, "vx":-0.10567, "vy":0.78082, "omega":0.00005, "ax":1.07507, "ay":-7.92318, "alpha":-0.00726, "fx":[17.01873,17.2416,16.9911,17.01868], "fy":[-125.79111,-125.76735,-125.79535,-125.79164]}, + {"t":3.50684, "x":5.62476, "y":5.71208, "heading":-1.57078, "vx":-0.05271, "vy":0.39048, "omega":-0.00031, "ax":1.06989, "ay":-7.92604, "alpha":0.00622, "fx":[17.02411,16.91285,16.984,17.02045], "fy":[-125.82615,-125.84097,-125.83228,-125.82745]}, + {"t":3.5561, "x":5.62346, "y":5.7217, "heading":-1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[ {"name":"IntakeDown", "from":{"target":0, "targetTimestamp":0.0, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeDown"}}}, - {"name":"IntakeUp", "from":{"target":2, "targetTimestamp":3.44813, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] + {"name":"IntakeUp", "from":{"target":2, "targetTimestamp":3.5561, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] } diff --git a/src/main/deploy/choreo/HubRight.traj b/src/main/deploy/choreo/HubRight.traj index e9a2071b..8c517b7c 100644 --- a/src/main/deploy/choreo/HubRight.traj +++ b/src/main/deploy/choreo/HubRight.traj @@ -4,8 +4,8 @@ "snapshot":{ "waypoints":[ {"x":5.616757392883301, "y":2.326812267303467, "heading":1.5609444415374634, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.790645122528076, "y":3.856259822845459, "heading":1.5774184900038868, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":5.625327110290527, "y":2.648164749145508, "heading":1.5707963267948966, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":5.790645122528076, "y":3.856259822845459, "heading":1.5774184900038868, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.630136966705322, "y":2.3510687351226807, "heading":1.5707963267948966, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -17,8 +17,8 @@ "params":{ "waypoints":[ {"x":{"exp":"5.616757392883301 m", "val":5.616757392883301}, "y":{"exp":"2.326812267303467 m", "val":2.326812267303467}, "heading":{"exp":"1.5609444415374634 rad", "val":1.5609444415374634}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.790645122528076 m", "val":5.790645122528076}, "y":{"exp":"3.856259822845459 m", "val":3.856259822845459}, "heading":{"exp":"1.5774184900038868 rad", "val":1.5774184900038868}, "intervals":28, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"5.625327110290527 m", "val":5.625327110290527}, "y":{"exp":"2.648164749145508 m", "val":2.648164749145508}, "heading":{"exp":"1.5707963267948966 rad", "val":1.5707963267948966}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"5.790645122528076 m", "val":5.790645122528076}, "y":{"exp":"3.856259822845459 m", "val":3.856259822845459}, "heading":{"exp":"1.5774184900038868 rad", "val":1.5774184900038868}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.630136966705322 m", "val":5.630136966705322}, "y":{"exp":"2.3510687351226807 m", "val":2.3510687351226807}, "heading":{"exp":"1.5707963267948966 rad", "val":1.5707963267948966}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -55,75 +55,81 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,1.67297,3.01784], + "waypoints":[0.0,1.67338,3.31248], "samples":[ - {"t":0.0, "x":5.61676, "y":2.32681, "heading":1.56094, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.97168, "ay":7.93636, "alpha":0.00401, "fx":[15.40808,15.44838,15.44501,15.40321], "fy":[125.99603,125.99151,125.99479,125.99961]}, - {"t":0.0478, "x":5.61787, "y":2.33588, "heading":1.56094, "vx":0.04645, "vy":0.37935, "omega":0.00019, "ax":0.9718, "ay":7.93628, "alpha":0.00369, "fx":[15.41131,15.44898,15.44464,15.40691], "fy":[125.99474,125.9905,125.99361,125.99796]}, - {"t":0.0956, "x":5.6212, "y":2.36308, "heading":1.56095, "vx":0.0929, "vy":0.7587, "omega":0.00037, "ax":0.59715, "ay":4.88909, "alpha":0.0373, "fx":[9.4213,9.60454,9.59018,9.30446], "fy":[77.50909,77.56565,77.68842,77.70823]}, - {"t":0.1434, "x":5.62632, "y":2.40493, "heading":1.56097, "vx":0.12144, "vy":0.99239, "omega":0.00215, "ax":0.00097, "ay":-0.0001, "alpha":-0.02899, "fx":[-0.13448,0.16334,0.16475,-0.13175], "fy":[-0.62413,1.15677,-0.2712,-0.26772]}, - {"t":0.1912, "x":5.63213, "y":2.45236, "heading":1.56107, "vx":0.12149, "vy":0.99239, "omega":0.00076, "ax":0.00009, "ay":-0.00001, "alpha":0.04728, "fx":[-0.1454,0.12933,0.13228,-0.11054], "fy":[-0.0381,-0.19797,0.11637,0.11902]}, - {"t":0.239, "x":5.63793, "y":2.4998, "heading":1.56111, "vx":0.12149, "vy":0.99238, "omega":0.00302, "ax":-0.00004, "ay":0.00001, "alpha":0.05184, "fx":[-0.11426,0.11049,0.11292,-0.11183], "fy":[-0.11687,-0.19363,0.15428,0.15654]}, - {"t":0.28679, "x":5.64374, "y":2.54723, "heading":1.56126, "vx":0.12149, "vy":0.99239, "omega":0.0055, "ax":-0.00011, "ay":0.00001, "alpha":0.04555, "fx":[-0.10624,0.1009,0.1031,-0.10471], "fy":[-0.15885,-0.10546,0.13162,0.13354]}, - {"t":0.33459, "x":5.64955, "y":2.59467, "heading":1.56152, "vx":0.12148, "vy":0.99239, "omega":0.00768, "ax":0.00011, "ay":-0.00001, "alpha":0.03727, "fx":[-0.08323,0.08484,0.08658,-0.08149], "fy":[-0.09591,-0.12228,0.10788,0.10949]}, - {"t":0.38239, "x":5.65535, "y":2.6421, "heading":1.56189, "vx":0.12149, "vy":0.99239, "omega":0.00946, "ax":-0.00007, "ay":0.00001, "alpha":0.0323, "fx":[-0.07993,0.07491,0.07643,-0.07565], "fy":[-0.09502,-0.08674,0.09048,0.09181]}, - {"t":0.43019, "x":5.66116, "y":2.68954, "heading":1.56234, "vx":0.12148, "vy":0.99239, "omega":0.01101, "ax":0.00001, "ay":0.0, "alpha":0.02674, "fx":[-0.06262,0.06164,0.06281,-0.06145], "fy":[-0.07527,-0.07784,0.07599,0.07707]}, - {"t":0.47799, "x":5.66697, "y":2.73697, "heading":1.56286, "vx":0.12149, "vy":0.99239, "omega":0.01228, "ax":0.00005, "ay":-0.00001, "alpha":0.02309, "fx":[-0.05751,0.0559,0.05689,-0.05186], "fy":[-0.06316,-0.06591,0.0639,0.06476]}, - {"t":0.52579, "x":5.67277, "y":2.78441, "heading":1.56345, "vx":0.12149, "vy":0.99239, "omega":0.01339, "ax":-0.00011, "ay":0.00001, "alpha":0.01899, "fx":[-0.04684,0.04249,0.04321,-0.04612], "fy":[-0.05506,-0.05231,0.05379,0.05446]}, - {"t":0.57359, "x":5.67858, "y":2.83184, "heading":1.56409, "vx":0.12148, "vy":0.99239, "omega":0.01429, "ax":0.00018, "ay":-0.00002, "alpha":0.01586, "fx":[-0.03883,0.04051,0.04109,-0.03144], "fy":[-0.04253,-0.047,0.04382,0.04432]}, - {"t":0.62139, "x":5.68439, "y":2.87928, "heading":1.56477, "vx":0.12149, "vy":0.99238, "omega":0.01505, "ax":-0.00024, "ay":0.00003, "alpha":0.01274, "fx":[-0.03426,0.02614,0.02653,-0.03386], "fy":[-0.03697,-0.03398,0.03624,0.03661]}, - {"t":0.66919, "x":5.6902, "y":2.92671, "heading":1.56549, "vx":0.12148, "vy":0.99239, "omega":0.01566, "ax":0.00032, "ay":-0.00004, "alpha":0.00973, "fx":[-0.02257,0.02757,0.02786,-0.01276], "fy":[-0.02644,-0.03035,0.02704,0.02729]}, - {"t":0.71699, "x":5.696, "y":2.97415, "heading":1.56624, "vx":0.12149, "vy":0.99238, "omega":0.01613, "ax":-0.00039, "ay":0.00005, "alpha":0.00734, "fx":[-0.02392,0.01139,0.01156,-0.02375], "fy":[-0.0207,-0.01881,0.02119,0.02134]}, - {"t":0.76478, "x":5.70181, "y":3.02158, "heading":1.56701, "vx":0.12148, "vy":0.99239, "omega":0.01648, "ax":0.00048, "ay":-0.00006, "alpha":0.0042, "fx":[-0.00768,0.01618,0.01627,0.0054], "fy":[-0.0124,-0.01533,0.01197,0.01206]}, - {"t":0.81258, "x":5.70762, "y":3.06902, "heading":1.5678, "vx":0.1215, "vy":0.99238, "omega":0.01668, "ax":-0.00056, "ay":0.00007, "alpha":0.00239, "fx":[-0.01505,-0.00278,-0.00274,-0.01501], "fy":[-0.00539,-0.00509,0.0074,0.00743]}, - {"t":0.86038, "x":5.71342, "y":3.11645, "heading":1.5686, "vx":0.12147, "vy":0.99239, "omega":0.01679, "ax":0.00066, "ay":-0.00008, "alpha":-0.00112, "fx":[0.00681,0.00557,0.00557,0.0242], "fy":[0.00081,-0.00104,-0.00246,-0.00246]}, - {"t":0.90818, "x":5.71923, "y":3.16389, "heading":1.5694, "vx":0.1215, "vy":0.99238, "omega":0.01674, "ax":-0.00077, "ay":0.00009, "alpha":-0.00247, "fx":[-0.00699,-0.01736,-0.01737,-0.007], "fy":[0.00989,0.00818,-0.00605,-0.00606]}, - {"t":0.95598, "x":5.72504, "y":3.21132, "heading":1.5702, "vx":0.12147, "vy":0.99239, "omega":0.01662, "ax":0.00089, "ay":-0.00011, "alpha":-0.00659, "fx":[0.02181,-0.00496,-0.00497,0.04484], "fy":[0.01413,0.0134,-0.01723,-0.01724]}, - {"t":1.00378, "x":5.73084, "y":3.25876, "heading":1.57099, "vx":0.12151, "vy":0.99238, "omega":0.01631, "ax":-0.00102, "ay":0.00013, "alpha":-0.00757, "fx":[0.0009,-0.03336,-0.03333,0.00092], "fy":[0.0261,0.022,-0.02008,-0.02007]}, - {"t":1.05158, "x":5.73665, "y":3.30619, "heading":1.57177, "vx":0.12146, "vy":0.99239, "omega":0.01594, "ax":0.00118, "ay":-0.00014, "alpha":-0.01256, "fx":[0.03826,-0.01612,-0.01605,0.0686], "fy":[0.02876,0.02884,-0.0334,-0.03334]}, - {"t":1.09938, "x":5.74246, "y":3.35363, "heading":1.57254, "vx":0.12152, "vy":0.99238, "omega":0.01534, "ax":-0.00133, "ay":0.00016, "alpha":-0.01331, "fx":[0.00931,-0.05179,-0.05165,0.00946], "fy":[0.04405,0.03795,-0.03588,-0.03576]}, - {"t":1.14718, "x":5.74826, "y":3.40106, "heading":1.57327, "vx":0.12145, "vy":0.99239, "omega":0.01471, "ax":0.00152, "ay":-0.00019, "alpha":-0.01954, "fx":[0.05717,-0.02877,-0.02852,0.09679], "fy":[0.04706,0.04587,-0.05249,-0.05228]}, - {"t":1.19498, "x":5.75407, "y":3.4485, "heading":1.57397, "vx":0.12153, "vy":0.99238, "omega":0.01377, "ax":-0.00171, "ay":0.00021, "alpha":-0.02028, "fx":[0.01907,-0.07386,-0.0735,0.01943], "fy":[0.06404,0.05991,-0.05548,-0.05515]}, - {"t":1.24277, "x":5.75988, "y":3.49593, "heading":1.57463, "vx":0.12144, "vy":0.99239, "omega":0.0128, "ax":0.00197, "ay":-0.00024, "alpha":-0.02837, "fx":[0.08012,-0.04364,-0.0431,0.13142], "fy":[0.07555,0.06401,-0.07765,-0.07718]}, - {"t":1.29057, "x":5.76569, "y":3.54337, "heading":1.57524, "vx":0.12154, "vy":0.99238, "omega":0.01145, "ax":-0.00204, "ay":0.00025, "alpha":-0.02972, "fx":[0.03341,-0.099,-0.09831,0.03411], "fy":[0.08416,0.09894,-0.08393,-0.08329]}, - {"t":1.33837, "x":5.77149, "y":3.5908, "heading":1.57579, "vx":0.12144, "vy":0.99239, "omega":0.01003, "ax":0.00211, "ay":-0.00026, "alpha":-0.04107, "fx":[0.10211,-0.06903,-0.06807,0.16902], "fy":[0.13538,0.07971,-0.11617,-0.11533]}, - {"t":1.38617, "x":5.7773, "y":3.63824, "heading":1.57627, "vx":0.12154, "vy":0.99238, "omega":0.00807, "ax":-0.00273, "ay":0.00033, "alpha":-0.04303, "fx":[0.04776,-0.13549,-0.13433,0.04892], "fy":[0.10421,0.1675,-0.12579,-0.12473]}, - {"t":1.43397, "x":5.78311, "y":3.68567, "heading":1.57666, "vx":0.12141, "vy":0.99239, "omega":0.00601, "ax":0.00701, "ay":-0.00086, "alpha":-0.04263, "fx":[0.21749,-0.01478,-0.01323,0.25564], "fy":[0.01896,0.1523,-0.11353,-0.11226]}, - {"t":1.48177, "x":5.78892, "y":3.73311, "heading":1.57694, "vx":0.12175, "vy":0.99235, "omega":0.00397, "ax":-0.11809, "ay":0.01412, "alpha":0.0301, "fx":[-1.75202,-2.00034,-1.99703,-1.7497], "fy":[0.78708,-0.85437,0.48128,0.4824]}, - {"t":1.52957, "x":5.7946, "y":3.78056, "heading":1.57713, "vx":0.1161, "vy":0.99303, "omega":0.00541, "ax":-2.80038, "ay":-5.33089, "alpha":-0.10573, "fx":[-44.8616,-44.85687,-44.82172,-43.2921], "fy":[-84.30719,-84.59273,-84.66335,-84.96374]}, - {"t":1.57737, "x":5.79695, "y":3.82193, "heading":1.57739, "vx":-0.01775, "vy":0.73822, "omega":0.00036, "ax":-1.01403, "ay":-7.931, "alpha":-0.00283, "fx":[-16.08618,-16.11458,-16.11074,-16.08223], "fy":[-125.9108,-125.90737,-125.9102,-125.91357]}, - {"t":1.62517, "x":5.79495, "y":3.84816, "heading":1.57741, "vx":-0.06622, "vy":0.35912, "omega":0.00022, "ax":-0.99314, "ay":-7.93591, "alpha":-0.0057, "fx":[-15.76471,-15.79739,-15.79306,-15.71206], "fy":[-125.98731,-125.98348,-125.98659,-125.99622]}, - {"t":1.67297, "x":5.79065, "y":3.85626, "heading":1.57742, "vx":-0.1137, "vy":-0.02021, "omega":-0.00005, "ax":-0.98673, "ay":-7.93453, "alpha":-0.00279, "fx":[-15.65292,-15.68,-15.67846,-15.64902], "fy":[-125.96657,-125.96369,-125.96601,-125.96939]}, - {"t":1.721, "x":5.78405, "y":3.84614, "heading":1.57742, "vx":-0.16109, "vy":-0.40131, "omega":-0.00019, "ax":-0.97592, "ay":-7.93579, "alpha":-0.00477, "fx":[-15.49331,-15.51886,-15.51543,-15.44606], "fy":[-125.98546,-125.98253,-125.98506,-125.99317]}, - {"t":1.76903, "x":5.77518, "y":3.81771, "heading":1.57741, "vx":-0.20796, "vy":-0.78247, "omega":-0.00042, "ax":1.67318, "ay":-4.35434, "alpha":-0.03322, "fx":[26.66184,26.46109,26.47105,26.65772], "fy":[-69.09247,-69.00803,-69.21227,-69.20035]}, - {"t":1.81706, "x":5.76712, "y":3.7751, "heading":1.57739, "vx":-0.1276, "vy":-0.99162, "omega":-0.00201, "ax":0.06469, "ay":-0.00824, "alpha":0.04445, "fx":[1.18206,0.9363,0.93853,1.05137], "fy":[-1.2891,0.44125,0.16168,0.16306]}, - {"t":1.86509, "x":5.76107, "y":3.72746, "heading":1.57729, "vx":-0.12449, "vy":-0.99201, "omega":0.00012, "ax":-0.00761, "ay":0.00096, "alpha":-0.03517, "fx":[-0.02338,-0.21956,-0.21811,-0.02196], "fy":[0.16985,0.03295,-0.07171,-0.07038]}, - {"t":1.91312, "x":5.75508, "y":3.67982, "heading":1.5773, "vx":-0.12486, "vy":-0.99197, "omega":-0.00157, "ax":0.00315, "ay":-0.0004, "alpha":-0.0447, "fx":[0.11355,-0.06348,-0.06219,0.21187], "fy":[0.15145,0.07586,-0.12678,-0.12566]}, - {"t":1.96115, "x":5.74909, "y":3.63217, "heading":1.57722, "vx":-0.12471, "vy":-0.99199, "omega":-0.00371, "ax":-0.00232, "ay":0.00029, "alpha":-0.0316, "fx":[0.03229,-0.10688,-0.10588,0.03329], "fy":[0.08139,0.11559,-0.0897,-0.08877]}, - {"t":2.00918, "x":5.7431, "y":3.58453, "heading":1.57704, "vx":-0.12482, "vy":-0.99197, "omega":-0.00523, "ax":0.00208, "ay":-0.00026, "alpha":-0.02925, "fx":[0.07766,-0.04492,-0.04407,0.14317], "fy":[0.08196,0.06044,-0.07986,-0.07912]}, - {"t":2.05721, "x":5.7371, "y":3.53688, "heading":1.57679, "vx":-0.12472, "vy":-0.99198, "omega":-0.00663, "ax":-0.0018, "ay":0.00023, "alpha":-0.01996, "fx":[0.01825,-0.0759,-0.07527,0.01889], "fy":[0.06136,0.05887,-0.05324,-0.05265]}, - {"t":2.10525, "x":5.73111, "y":3.48923, "heading":1.57647, "vx":-0.1248, "vy":-0.99197, "omega":-0.00759, "ax":0.00157, "ay":-0.0002, "alpha":-0.01815, "fx":[0.05275,-0.02535,-0.02485,0.09729], "fy":[0.04276,0.04101,-0.04838,-0.04795]}, - {"t":2.15328, "x":5.72512, "y":3.44159, "heading":1.57611, "vx":-0.12473, "vy":-0.99198, "omega":-0.00847, "ax":-0.00134, "ay":0.00017, "alpha":-0.01152, "fx":[0.007,-0.05,-0.04966,0.00734], "fy":[0.03835,0.02996,-0.02894,-0.02864]}, - {"t":2.20131, "x":5.71913, "y":3.39394, "heading":1.5757, "vx":-0.12479, "vy":-0.99198, "omega":-0.00902, "ax":0.00116, "ay":-0.00015, "alpha":-0.00943, "fx":[0.03065,-0.00906,-0.00884,0.06071], "fy":[0.01908,0.02079,-0.02465,-0.02447]}, - {"t":2.24934, "x":5.71313, "y":3.3463, "heading":1.57527, "vx":-0.12474, "vy":-0.99198, "omega":-0.00947, "ax":-0.00098, "ay":0.00012, "alpha":-0.00441, "fx":[-0.00339,-0.02774,-0.02763,-0.00328], "fy":[0.01623,0.00953,-0.00902,-0.00893]}, - {"t":2.29737, "x":5.70714, "y":3.29865, "heading":1.57481, "vx":-0.12478, "vy":-0.99198, "omega":-0.00968, "ax":0.00082, "ay":-0.0001, "alpha":-0.00174, "fx":[0.01048,0.00594,0.00595,0.02972], "fy":[0.00005,0.00126,-0.00393,-0.00393]}, - {"t":2.3454, "x":5.70115, "y":3.25101, "heading":1.57435, "vx":-0.12474, "vy":-0.99198, "omega":-0.00977, "ax":-0.00067, "ay":0.00008, "alpha":0.00221, "fx":[-0.01373,-0.00748,-0.00752,-0.01377], "fy":[-0.00488,-0.00867,0.00948,0.00942]}, - {"t":2.39343, "x":5.69516, "y":3.20336, "heading":1.57388, "vx":-0.12478, "vy":-0.99198, "omega":-0.00966, "ax":0.00054, "ay":-0.00007, "alpha":0.00563, "fx":[-0.00898,0.02067,0.02054,0.00181], "fy":[-0.01817,-0.01796,0.01598,0.01587]}, - {"t":2.44146, "x":5.68916, "y":3.15571, "heading":1.57342, "vx":-0.12475, "vy":-0.99198, "omega":-0.00939, "ax":-0.00041, "ay":0.00005, "alpha":0.00889, "fx":[-0.02483,0.01208,0.01194,-0.02497], "fy":[-0.02571,-0.02746,0.02828,0.02813]}, - {"t":2.48949, "x":5.68317, "y":3.10807, "heading":1.57296, "vx":-0.12477, "vy":-0.99198, "omega":-0.00896, "ax":0.00029, "ay":-0.00004, "alpha":0.01324, "fx":[-0.02884,0.03612,0.03592,-0.02489], "fy":[-0.03825,-0.03753,0.03682,0.03665]}, - {"t":2.53752, "x":5.67718, "y":3.06042, "heading":1.57253, "vx":-0.12476, "vy":-0.99198, "omega":-0.00833, "ax":-0.00017, "ay":0.00002, "alpha":0.01621, "fx":[-0.03751,0.03223,0.03206,-0.03769], "fy":[-0.04675,-0.05032,0.04931,0.04912]}, - {"t":2.58556, "x":5.67119, "y":3.01278, "heading":1.57213, "vx":-0.12476, "vy":-0.99198, "omega":-0.00755, "ax":0.00006, "ay":-0.00001, "alpha":0.02185, "fx":[-0.05025,0.05336,0.05315,-0.0523], "fy":[-0.06542,-0.05736,0.06123,0.06105]}, - {"t":2.63359, "x":5.66519, "y":2.96513, "heading":1.57177, "vx":-0.12476, "vy":-0.99198, "omega":-0.0065, "ax":0.00003, "ay":0.0, "alpha":0.02519, "fx":[-0.05309,0.05414,0.05397,-0.05325], "fy":[-0.06697,-0.08597,0.07645,0.07627]}, - {"t":2.68162, "x":5.6592, "y":2.91749, "heading":1.57146, "vx":-0.12476, "vy":-0.99198, "omega":-0.00529, "ax":-0.00008, "ay":0.00001, "alpha":0.03306, "fx":[-0.07328,0.07517,0.07498,-0.08219], "fy":[-0.11507,-0.07464,0.09527,0.09511]}, - {"t":2.72965, "x":5.65321, "y":2.86984, "heading":1.57121, "vx":-0.12476, "vy":-0.99198, "omega":-0.0037, "ax":-0.00002, "ay":0.0, "alpha":0.03673, "fx":[-0.07645,0.07604,0.07592,-0.07658], "fy":[-0.08648,-0.13967,0.11321,0.11307]}, - {"t":2.77768, "x":5.64722, "y":2.82219, "heading":1.57103, "vx":-0.12477, "vy":-0.99198, "omega":-0.00194, "ax":0.00018, "ay":-0.00002, "alpha":0.03418, "fx":[-0.10292,0.0997,0.09956,-0.08502], "fy":[-0.01649,-0.14961,0.0824,0.08228]}, - {"t":2.82571, "x":5.64122, "y":2.77455, "heading":1.57093, "vx":-0.12476, "vy":-0.99198, "omega":-0.00029, "ax":-0.00106, "ay":0.00015, "alpha":-0.03833, "fx":[-0.12104,0.08793,0.08685,-0.12131], "fy":[-0.54468,1.10697,-0.27629,-0.27628]}, - {"t":2.87374, "x":5.63523, "y":2.7269, "heading":1.57092, "vx":-0.12481, "vy":-0.99197, "omega":-0.00214, "ax":0.60284, "ay":4.78433, "alpha":0.03838, "fx":[9.55515,9.66431,9.65186,9.41099], "fy":[75.7315,75.95514,76.05714,76.07492]}, - {"t":2.92177, "x":5.62993, "y":2.68478, "heading":1.57082, "vx":-0.09585, "vy":-0.76218, "omega":-0.00029, "ax":0.99762, "ay":7.9331, "alpha":0.0028, "fx":[15.8257,15.85411,15.85031,15.82196], "fy":[125.94418,125.94077,125.94339,125.94672]}, - {"t":2.9698, "x":5.62648, "y":2.65732, "heading":1.5708, "vx":-0.04794, "vy":-0.38114, "omega":-0.00016, "ax":0.99801, "ay":7.93531, "alpha":0.00329, "fx":[15.82976,15.86563,15.85589,15.82554], "fy":[125.97939,125.97511,125.97869,125.98226]}, - {"t":3.01784, "x":5.62533, "y":2.64816, "heading":1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":5.61676, "y":2.32681, "heading":1.56094, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.88173, "ay":7.94686, "alpha":0.00384, "fx":[13.98069,14.01904,14.01657,13.9762], "fy":[126.16262,126.15851,126.16166,126.16589]}, + {"t":0.04781, "x":5.61777, "y":2.3359, "heading":1.56094, "vx":0.04216, "vy":0.37995, "omega":0.00018, "ax":0.88152, "ay":7.94681, "alpha":0.00336, "fx":[13.97954,14.01198,14.01208,13.97554], "fy":[126.16184,126.15838,126.16093,126.16476]}, + {"t":0.09562, "x":5.62079, "y":2.36314, "heading":1.56095, "vx":0.0843, "vy":0.75989, "omega":0.00034, "ax":0.54485, "ay":4.88998, "alpha":0.02539, "fx":[8.57853,8.73948,8.73252,8.54925], "fy":[77.58313,77.58269,77.67494,77.68739]}, + {"t":0.14343, "x":5.62544, "y":2.40506, "heading":1.56097, "vx":0.11035, "vy":0.99368, "omega":0.00156, "ax":-0.00281, "ay":0.00033, "alpha":0.03706, "fx":[-0.13796,0.04868,0.04837,-0.13724], "fy":[-0.1001,-0.08955,0.10412,0.10656]}, + {"t":0.19124, "x":5.63071, "y":2.45257, "heading":1.56104, "vx":0.11022, "vy":0.9937, "omega":0.00333, "ax":0.00235, "ay":-0.00026, "alpha":0.0553, "fx":[-0.03279,0.12942,0.1309,-0.07798], "fy":[-0.38984,0.00052,0.18561,0.18711]}, + {"t":0.23905, "x":5.63599, "y":2.50008, "heading":1.5612, "vx":0.11033, "vy":0.99369, "omega":0.00597, "ax":-0.00137, "ay":0.00015, "alpha":0.03984, "fx":[-0.09016,0.04538,0.04665,-0.08889], "fy":[-0.01844,-0.24724,0.13711,0.13823]}, + {"t":0.28687, "x":5.64126, "y":2.54759, "heading":1.56149, "vx":0.11027, "vy":0.99369, "omega":0.00788, "ax":0.0004, "ay":-0.00004, "alpha":0.03075, "fx":[-0.0488,0.06705,0.06808,-0.06079], "fy":[-0.15951,-0.03647,0.09612,0.09702]}, + {"t":0.33468, "x":5.64653, "y":2.5951, "heading":1.56187, "vx":0.11028, "vy":0.99369, "omega":0.00935, "ax":-0.00019, "ay":0.00002, "alpha":0.02402, "fx":[-0.05264,0.0458,0.04662,-0.05182], "fy":[-0.03699,-0.11107,0.07434,0.07505]}, + {"t":0.38249, "x":5.65181, "y":2.64261, "heading":1.56231, "vx":0.11028, "vy":0.99369, "omega":0.0105, "ax":0.00012, "ay":-0.00001, "alpha":0.01952, "fx":[-0.03848,0.04427,0.04491,-0.04291], "fy":[-0.08032,-0.03684,0.05787,0.05843]}, + {"t":0.4303, "x":5.65708, "y":2.69012, "heading":1.56281, "vx":0.11028, "vy":0.99369, "omega":0.01143, "ax":-0.00008, "ay":0.00001, "alpha":0.01591, "fx":[-0.03703,0.03391,0.03442,-0.03652], "fy":[-0.03263,-0.06067,0.04672,0.04716]}, + {"t":0.47811, "x":5.66235, "y":2.73763, "heading":1.56336, "vx":0.11028, "vy":0.99369, "omega":0.01219, "ax":0.00004, "ay":0.0, "alpha":0.01313, "fx":[-0.02811,0.03038,0.03076,-0.03079], "fy":[-0.04713,-0.02911,0.03783,0.03816]}, + {"t":0.52592, "x":5.66762, "y":2.78514, "heading":1.56394, "vx":0.11028, "vy":0.99369, "omega":0.01282, "ax":0.0, "ay":0.0, "alpha":0.01078, "fx":[-0.02507,0.02485,0.02515,-0.02477], "fy":[-0.02459,-0.03725,0.03079,0.03104]}, + {"t":0.57373, "x":5.6729, "y":2.83265, "heading":1.56456, "vx":0.11028, "vy":0.99369, "omega":0.01333, "ax":-0.00004, "ay":0.0, "alpha":0.00876, "fx":[-0.01999,0.01986,0.02007,-0.02224], "fy":[-0.029,-0.02072,0.02489,0.02508]}, + {"t":0.62154, "x":5.67817, "y":2.88016, "heading":1.56519, "vx":0.11028, "vy":0.99369, "omega":0.01375, "ax":0.00007, "ay":-0.00001, "alpha":0.00696, "fx":[-0.01544,0.01752,0.01768,-0.01528], "fy":[-0.01694,-0.02264,0.01947,0.01961]}, + {"t":0.66935, "x":5.68344, "y":2.92767, "heading":1.56585, "vx":0.11028, "vy":0.99369, "omega":0.01409, "ax":-0.00011, "ay":0.00001, "alpha":0.0054, "fx":[-0.01345,0.01123,0.01133,-0.01591], "fy":[-0.01677,-0.01302,0.01522,0.01531]}, + {"t":0.71716, "x":5.68871, "y":2.97517, "heading":1.56653, "vx":0.11028, "vy":0.99369, "omega":0.01434, "ax":0.00014, "ay":-0.00002, "alpha":0.00386, "fx":[-0.00698,0.0115,0.01157,-0.00691], "fy":[-0.00994,-0.01218,0.01052,0.01058]}, + {"t":0.76497, "x":5.69399, "y":3.02268, "heading":1.56721, "vx":0.11028, "vy":0.99369, "omega":0.01453, "ax":-0.00019, "ay":0.00002, "alpha":0.0026, "fx":[-0.00793,0.00359,0.00362,-0.0111], "fy":[-0.00743,-0.00589,0.0073,0.00733]}, + {"t":0.81278, "x":5.69926, "y":3.07019, "heading":1.56791, "vx":0.11027, "vy":0.99369, "omega":0.01465, "ax":0.00023, "ay":-0.00003, "alpha":0.00111, "fx":[0.00096,0.00631,0.00633,0.00098], "fy":[-0.00342,-0.00362,0.00271,0.00272]}, + {"t":0.8606, "x":5.70453, "y":3.1177, "heading":1.56861, "vx":0.11028, "vy":0.99369, "omega":0.01471, "ax":-0.00028, "ay":0.00003, "alpha":0.00004, "fx":[-0.00302,-0.00372,-0.00372,-0.00722], "fy":[0.00093,0.00088,0.00008,0.00007]}, + {"t":0.90841, "x":5.7098, "y":3.16521, "heading":1.56931, "vx":0.11027, "vy":0.99369, "omega":0.01471, "ax":0.00033, "ay":-0.00004, "alpha":-0.00154, "fx":[0.0089,0.00158,0.00156,0.00889], "fy":[0.00278,0.00474,-0.00491,-0.00492]}, + {"t":0.95622, "x":5.71508, "y":3.21272, "heading":1.57001, "vx":0.11029, "vy":0.99369, "omega":0.01463, "ax":-0.00039, "ay":0.00004, "alpha":-0.00255, "fx":[0.00165,-0.01127,-0.01128,-0.00372], "fy":[0.00991,0.00747,-0.00732,-0.00733]}, + {"t":1.00403, "x":5.72035, "y":3.26023, "heading":1.57071, "vx":0.11027, "vy":0.99369, "omega":0.01451, "ax":0.00045, "ay":-0.00005, "alpha":-0.00437, "fx":[0.01733,-0.00308,-0.00309,0.01732], "fy":[0.00881,0.01458,-0.01327,-0.01328]}, + {"t":1.05184, "x":5.72562, "y":3.30774, "heading":1.57141, "vx":0.11029, "vy":0.99369, "omega":0.0143, "ax":-0.00052, "ay":0.00006, "alpha":-0.00548, "fx":[0.00647,-0.01969,-0.01969,-0.00007], "fy":[0.02141,0.01404,-0.0159,-0.0159]}, + {"t":1.09965, "x":5.73089, "y":3.35525, "heading":1.57209, "vx":0.11027, "vy":0.99369, "omega":0.01404, "ax":0.00059, "ay":-0.00007, "alpha":-0.00772, "fx":[0.02685,-0.00805,-0.00804,0.02687], "fy":[0.01478,0.02818,-0.02358,-0.02356]}, + {"t":1.14746, "x":5.73617, "y":3.40276, "heading":1.57276, "vx":0.11029, "vy":0.99369, "omega":0.01367, "ax":-0.00068, "ay":0.00008, "alpha":-0.00918, "fx":[0.01191,-0.02983,-0.02978,0.00439], "fy":[0.03847,0.02061,-0.02716,-0.02712]}, + {"t":1.19527, "x":5.74144, "y":3.45027, "heading":1.57342, "vx":0.11026, "vy":0.9937, "omega":0.01323, "ax":0.00077, "ay":-0.00009, "alpha":-0.01215, "fx":[0.03836,-0.01393,-0.01384,0.03844], "fy":[0.0203,0.05026,-0.03804,-0.03796]}, + {"t":1.24308, "x":5.74671, "y":3.49778, "heading":1.57405, "vx":0.1103, "vy":0.99369, "omega":0.01265, "ax":-0.00089, "ay":0.0001, "alpha":-0.01465, "fx":[0.01853,-0.04309,-0.04295,0.01114], "fy":[0.07032,0.02562,-0.0449,-0.04479]}, + {"t":1.29089, "x":5.75198, "y":3.54529, "heading":1.57465, "vx":0.11026, "vy":0.9937, "omega":0.01195, "ax":0.00101, "ay":-0.00011, "alpha":-0.0193, "fx":[0.05331,-0.02141,-0.0212,0.05352], "fy":[0.02108,0.09909,-0.06374,-0.06356]}, + {"t":1.3387, "x":5.75726, "y":3.5928, "heading":1.57522, "vx":0.1103, "vy":0.99369, "omega":0.01103, "ax":-0.00111, "ay":0.00012, "alpha":-0.02476, "fx":[0.02689,-0.06186,-0.06156,0.02584], "fy":[0.14816,0.02085,-0.08072,-0.08046]}, + {"t":1.38651, "x":5.76253, "y":3.64031, "heading":1.57575, "vx":0.11025, "vy":0.9937, "omega":0.00985, "ax":0.00176, "ay":-0.0002, "alpha":-0.03367, "fx":[0.08024,-0.02483,-0.02441,0.08067], "fy":[-0.0006,0.23263,-0.1224,-0.12203]}, + {"t":1.43433, "x":5.7678, "y":3.68781, "heading":1.57622, "vx":0.11033, "vy":0.99369, "omega":0.00824, "ax":-0.00466, "ay":0.00052, "alpha":-0.04964, "fx":[-0.02028,-0.1475,-0.14681,0.01876], "fy":[0.39842,-0.02522,-0.17041,-0.16997]}, + {"t":1.48214, "x":5.77307, "y":3.73532, "heading":1.57662, "vx":0.11011, "vy":0.99371, "omega":0.00586, "ax":0.06145, "ay":-0.00693, "alpha":-0.0324, "fx":[1.04862,0.90054,0.9031,1.05026], "fy":[-0.03946,0.00752,-0.2043,-0.20411]}, + {"t":1.52995, "x":5.77841, "y":3.78283, "heading":1.5769, "vx":0.11305, "vy":0.99338, "omega":0.00431, "ax":-0.00519, "ay":-5.72334, "alpha":-0.01956, "fx":[0.06859,-0.05411,-0.0486,-0.29578], "fy":[-90.55754,-90.92105,-90.98414,-90.98623]}, + {"t":1.57776, "x":5.7838, "y":3.82378, "heading":1.5771, "vx":0.1128, "vy":0.71974, "omega":0.00338, "ax":-0.86035, "ay":-7.94915, "alpha":-0.00294, "fx":[-13.64562,-13.67399,-13.6736,-13.64169], "fy":[-126.1987,-126.19588,-126.19814,-126.20137]}, + {"t":1.62557, "x":5.78821, "y":3.84911, "heading":1.57726, "vx":0.07167, "vy":0.33969, "omega":0.00324, "ax":-0.87145, "ay":-7.95019, "alpha":-0.00243, "fx":[-13.81149,-13.84979,-13.84562,-13.833], "fy":[-126.21632,-126.21241,-126.21535,-126.2166]}, + {"t":1.67338, "x":5.79065, "y":3.85626, "heading":1.57742, "vx":0.03, "vy":-0.04042, "omega":0.00312, "ax":-0.87413, "ay":-7.94774, "alpha":-0.00309, "fx":[-13.86386,-13.89448,-13.89196,-13.8597], "fy":[-126.17642,-126.17313,-126.17587,-126.17918]}, + {"t":1.72159, "x":5.79108, "y":3.84508, "heading":1.57757, "vx":-0.01214, "vy":-0.42357, "omega":0.00297, "ax":-0.8791, "ay":-7.94712, "alpha":-0.00171, "fx":[-13.93471,-13.96729,-13.96353,-13.95981], "fy":[-126.16751,-126.16415,-126.16665,-126.16697]}, + {"t":1.7698, "x":5.78947, "y":3.81542, "heading":1.57771, "vx":-0.05452, "vy":-0.80669, "omega":0.00289, "ax":-1.09708, "ay":-3.88557, "alpha":0.01238, "fx":[-17.36629,-17.46048,-17.48249,-17.35845], "fy":[-61.49555,-62.09535,-61.57362,-61.5808]}, + {"t":1.81801, "x":5.78557, "y":3.77202, "heading":1.57785, "vx":-0.10741, "vy":-0.99401, "omega":0.00349, "ax":-0.03221, "ay":0.0035, "alpha":-0.03999, "fx":[-0.44125,-0.57874,-0.57673,-0.44844], "fy":[0.31623,0.06931,-0.08171,-0.08182]}, + {"t":1.86621, "x":5.78035, "y":3.7241, "heading":1.57802, "vx":-0.10896, "vy":-0.99384, "omega":0.00156, "ax":0.00581, "ay":-0.00064, "alpha":-0.0491, "fx":[0.14886,0.0348,0.03559,0.14961], "fy":[-0.06887,0.43112,-0.20162,-0.20103]}, + {"t":1.91442, "x":5.7751, "y":3.67619, "heading":1.57809, "vx":-0.10868, "vy":-0.99387, "omega":-0.00081, "ax":-0.00179, "ay":0.0002, "alpha":-0.03076, "fx":[0.02329,-0.07399,-0.07343,0.01042], "fy":[0.22389,0.00357,-0.10775,-0.10728]}, + {"t":1.96263, "x":5.76986, "y":3.62828, "heading":1.57806, "vx":-0.10877, "vy":-0.99386, "omega":-0.00229, "ax":0.00143, "ay":-0.00016, "alpha":-0.0234, "fx":[0.06405,-0.01921,-0.01878,0.06448], "fy":[0.01289,0.13876,-0.08096,-0.0806]}, + {"t":2.01084, "x":5.76462, "y":3.58036, "heading":1.57795, "vx":-0.1087, "vy":-0.99387, "omega":-0.00342, "ax":-0.00122, "ay":0.00013, "alpha":-0.01726, "fx":[0.01888,-0.05018,-0.04987,0.00369], "fy":[0.09602,0.02342,-0.05562,-0.05535]}, + {"t":2.05905, "x":5.75938, "y":3.53245, "heading":1.57778, "vx":-0.10876, "vy":-0.99386, "omega":-0.00425, "ax":0.00102, "ay":-0.00011, "alpha":-0.01463, "fx":[0.04676,-0.01451,-0.01425,0.04702], "fy":[0.02015,0.06613,-0.0468,-0.0466]}, + {"t":2.10726, "x":5.75414, "y":3.48454, "heading":1.57758, "vx":-0.10871, "vy":-0.99387, "omega":-0.00496, "ax":-0.00086, "ay":0.00009, "alpha":-0.01108, "fx":[0.01402,-0.03548,-0.03532,0.00225], "fy":[0.05038,0.02292,-0.03374,-0.03359]}, + {"t":2.15547, "x":5.7489, "y":3.43662, "heading":1.57734, "vx":-0.10875, "vy":-0.99386, "omega":-0.00549, "ax":0.00074, "ay":-0.00008, "alpha":-0.00997, "fx":[0.03434,-0.01108,-0.01093,0.03448], "fy":[0.01771,0.03765,-0.03029,-0.03019]}, + {"t":2.20368, "x":5.74365, "y":3.38871, "heading":1.57707, "vx":-0.10871, "vy":-0.99387, "omega":-0.00597, "ax":-0.00064, "ay":0.00007, "alpha":-0.00752, "fx":[0.00968,-0.02569,-0.02561,0.00101], "fy":[0.03037,0.01832,-0.02216,-0.02209]}, + {"t":2.25188, "x":5.73841, "y":3.3408, "heading":1.57678, "vx":-0.10874, "vy":-0.99386, "omega":-0.00633, "ax":0.00055, "ay":-0.00006, "alpha":-0.00691, "fx":[0.02535,-0.00795,-0.00788,0.02542], "fy":[0.01363,0.02301,-0.02025,-0.02021]}, + {"t":2.30009, "x":5.73317, "y":3.29288, "heading":1.57648, "vx":-0.10872, "vy":-0.99387, "omega":-0.00667, "ax":-0.00048, "ay":0.00005, "alpha":-0.00502, "fx":[0.00629,-0.01816,-0.01814,-0.00019], "fy":[0.01876,0.0135,-0.01448,-0.01447]}, + {"t":2.3483, "x":5.72793, "y":3.24497, "heading":1.57616, "vx":-0.10874, "vy":-0.99386, "omega":-0.00691, "ax":0.00041, "ay":-0.00004, "alpha":-0.00461, "fx":[0.01813,-0.00521,-0.00518,0.01816], "fy":[0.00947,0.01387,-0.01309,-0.01309]}, + {"t":2.39651, "x":5.72269, "y":3.19706, "heading":1.57582, "vx":-0.10872, "vy":-0.99387, "omega":-0.00713, "ax":-0.00035, "ay":0.00004, "alpha":-0.00307, "fx":[0.00336,-0.012,-0.01201,-0.00149], "fy":[0.01107,0.00884,-0.00874,-0.00875]}, + {"t":2.44472, "x":5.71745, "y":3.14915, "heading":1.57548, "vx":-0.10874, "vy":-0.99386, "omega":-0.00728, "ax":0.00029, "ay":-0.00003, "alpha":-0.00271, "fx":[0.01196,-0.00261,-0.00262,0.01195], "fy":[0.00539,0.00741,-0.00741,-0.00743]}, + {"t":2.49293, "x":5.7122, "y":3.10123, "heading":1.57513, "vx":-0.10872, "vy":-0.99387, "omega":-0.00741, "ax":-0.00025, "ay":0.00003, "alpha":-0.00136, "fx":[0.00063,-0.00659,-0.00662,-0.00304], "fy":[0.0051,0.00439,-0.00388,-0.0039]}, + {"t":2.54114, "x":5.70696, "y":3.05332, "heading":1.57477, "vx":-0.10873, "vy":-0.99386, "omega":-0.00748, "ax":0.0002, "ay":-0.00002, "alpha":-0.00096, "fx":[0.00636,0.00005,0.00002,0.00634], "fy":[0.00143,0.00179,-0.00229,-0.00232]}, + {"t":2.58935, "x":5.70172, "y":3.00541, "heading":1.57441, "vx":-0.10872, "vy":-0.99386, "omega":-0.00752, "ax":-0.00016, "ay":0.00002, "alpha":0.00031, "fx":[-0.00214,-0.00148,-0.00152,-0.00504], "fy":[-0.00077,0.00014,0.00089,0.00086]}, + {"t":2.63755, "x":5.69648, "y":2.95749, "heading":1.57405, "vx":-0.10873, "vy":-0.99386, "omega":-0.00751, "ax":0.00012, "ay":-0.00001, "alpha":0.00084, "fx":[0.00094,0.00296,0.00293,0.00091], "fy":[-0.00237,-0.00455,0.00305,0.00302]}, + {"t":2.68576, "x":5.69124, "y":2.90958, "heading":1.57369, "vx":-0.10873, "vy":-0.99386, "omega":-0.00747, "ax":-0.00009, "ay":0.00001, "alpha":0.00217, "fx":[-0.00517,0.00376,0.00372,-0.00774], "fy":[-0.00819,-0.00387,0.00635,0.00631]}, + {"t":2.73397, "x":5.686, "y":2.86167, "heading":1.57333, "vx":-0.10873, "vy":-0.99386, "omega":-0.00736, "ax":0.00005, "ay":-0.00001, "alpha":0.00295, "fx":[-0.00473,0.00634,0.0063,-0.00477], "fy":[-0.0059,-0.0135,0.00955,0.00951]}, + {"t":2.78218, "x":5.68075, "y":2.81376, "heading":1.57297, "vx":-0.10873, "vy":-0.99386, "omega":-0.00722, "ax":-0.00001, "ay":0.0, "alpha":0.00453, "fx":[-0.00873,0.0097,0.00965,-0.01127], "fy":[-0.01963,-0.00748,0.01361,0.01357]}, + {"t":2.83039, "x":5.67551, "y":2.76584, "heading":1.57262, "vx":-0.10873, "vy":-0.99386, "omega":-0.007, "ax":-0.00004, "ay":0.0, "alpha":0.00578, "fx":[-0.01145,0.01029,0.01024,-0.01149], "fy":[-0.00861,-0.02884,0.01888,0.01883]}, + {"t":2.8786, "x":5.67027, "y":2.71793, "heading":1.57229, "vx":-0.10873, "vy":-0.99386, "omega":-0.00672, "ax":0.00008, "ay":-0.00001, "alpha":0.00811, "fx":[-0.01314,0.01724,0.01719,-0.01602], "fy":[-0.04274,-0.00911,0.02566,0.02562]}, + {"t":2.92681, "x":5.66503, "y":2.67002, "heading":1.57196, "vx":-0.10873, "vy":-0.99386, "omega":-0.00633, "ax":-0.00016, "ay":0.00002, "alpha":0.01067, "fx":[-0.02021,0.01522,0.01517,-0.02026], "fy":[-0.00629,-0.06662,0.03703,0.03698]}, + {"t":2.97502, "x":5.65979, "y":2.6221, "heading":1.57166, "vx":-0.10873, "vy":-0.99386, "omega":-0.00582, "ax":0.00036, "ay":-0.00004, "alpha":0.01539, "fx":[-0.01596,0.03071,0.03065,-0.02272], "fy":[-0.10754,-0.00057,0.05284,0.05279]}, + {"t":3.02322, "x":5.65455, "y":2.57419, "heading":1.57138, "vx":-0.10872, "vy":-0.99387, "omega":-0.00508, "ax":-0.00116, "ay":0.00013, "alpha":0.02181, "fx":[-0.04538,0.00848,0.00843,-0.04544], "fy":[0.01985,-0.18227,0.08527,0.08523]}, + {"t":3.07143, "x":5.6493, "y":2.52628, "heading":1.57113, "vx":-0.10877, "vy":-0.99386, "omega":-0.00402, "ax":0.00192, "ay":-0.00021, "alpha":0.04168, "fx":[0.00688,0.07662,0.07652,-0.03802], "fy":[-0.41466,0.08062,0.16035,0.16034]}, + {"t":3.11964, "x":5.64406, "y":2.47837, "heading":1.57094, "vx":-0.10868, "vy":-0.99387, "omega":-0.00201, "ax":-0.00116, "ay":0.00015, "alpha":0.02843, "fx":[-0.0585,0.02241,0.02137,-0.059], "fy":[0.01191,-0.21509,0.10609,0.10633]}, + {"t":3.16785, "x":5.63882, "y":2.43045, "heading":1.57084, "vx":-0.10874, "vy":-0.99386, "omega":-0.00064, "ax":0.51644, "ay":4.71723, "alpha":0.00943, "fx":[8.15668,8.24555,8.24044,8.15269], "fy":[74.91612,74.84777,74.89444,74.89963]}, + {"t":3.21606, "x":5.63418, "y":2.38802, "heading":1.57081, "vx":-0.08384, "vy":-0.76645, "omega":-0.00019, "ax":0.86942, "ay":7.94819, "alpha":0.00173, "fx":[13.79491,13.81131,13.81175,13.79271], "fy":[126.18348,126.18187,126.18313,126.18508]}, + {"t":3.26427, "x":5.63115, "y":2.36031, "heading":1.5708, "vx":-0.04193, "vy":-0.38328, "omega":-0.00011, "ax":0.86968, "ay":7.95041, "alpha":0.00219, "fx":[13.79691,13.82072,13.81533,13.79448], "fy":[126.21882,126.21636,126.21847,126.2206]}, + {"t":3.31248, "x":5.63014, "y":2.35107, "heading":1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[ {"name":"IntakeDown", "from":{"target":0, "targetTimestamp":0.0, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeDown"}}}, - {"name":"IntakeUp", "from":{"target":2, "targetTimestamp":3.01784, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] + {"name":"IntakeUp", "from":{"target":2, "targetTimestamp":3.31248, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] } diff --git a/src/main/deploy/choreo/LeftSecondDip.traj b/src/main/deploy/choreo/LeftSecondDip.traj index cd07892b..26fba0d4 100644 --- a/src/main/deploy/choreo/LeftSecondDip.traj +++ b/src/main/deploy/choreo/LeftSecondDip.traj @@ -3,16 +3,16 @@ "version":3, "snapshot":{ "waypoints":[ - {"x":5.611854076385498, "y":5.705188751220703, "heading":-1.5657181171509245, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.429483413696289, "y":6.459790229797363, "heading":-0.00631101017301983, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":7.390566825866699, "y":6.004539966583252, "heading":-0.8915152357196665, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.611854076385498, "y":5.705188751220703, "heading":-1.5657181171509245, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.429483413696289, "y":6.459790229797363, "heading":-0.00631101017301983, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":7.390566825866699, "y":6.004539966583252, "heading":-0.8915152357196665, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":7.448474407196045, "y":4.726224899291992, "heading":-2.5646739792250837, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.469950199127197, "y":4.578090190887451, "heading":-3.1254652057435086, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.469950199127197, "y":4.578090190887451, "heading":-3.1254652057435086, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":6.04764461517334, "y":5.082523822784424, "heading":-2.594308272602356, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":5.611854076385498, "y":5.705188274383545, "heading":-1.564467367692855, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":true}, - {"from":0, "to":6, "data":{"type":"MaxAcceleration", "props":{"max":3.75}}, "enabled":true}, + {"from":0, "to":6, "data":{"type":"MaxAcceleration", "props":{"max":4.0}}, "enabled":true}, {"from":0, "to":6, "data":{"type":"MaxAngularVelocity", "props":{"max":4.0}}, "enabled":true}, {"from":3, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -25,16 +25,16 @@ }, "params":{ "waypoints":[ - {"x":{"exp":"5.611854076385498 m", "val":5.611854076385498}, "y":{"exp":"5.705188751220703 m", "val":5.705188751220703}, "heading":{"exp":"-1.5657181171509245 rad", "val":-1.5657181171509245}, "intervals":34, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.429483413696289 m", "val":6.429483413696289}, "y":{"exp":"6.459790229797363 m", "val":6.459790229797363}, "heading":{"exp":"-6.31101017301983 mrad", "val":-0.00631101017301983}, "intervals":30, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"7.390566825866699 m", "val":7.390566825866699}, "y":{"exp":"6.004539966583252 m", "val":6.004539966583252}, "heading":{"exp":"-0.8915152357196665 rad", "val":-0.8915152357196665}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.611854076385498 m", "val":5.611854076385498}, "y":{"exp":"5.705188751220703 m", "val":5.705188751220703}, "heading":{"exp":"-1.5657181171509245 rad", "val":-1.5657181171509245}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.429483413696289 m", "val":6.429483413696289}, "y":{"exp":"6.459790229797363 m", "val":6.459790229797363}, "heading":{"exp":"-6.31101017301983 mrad", "val":-0.00631101017301983}, "intervals":29, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"7.390566825866699 m", "val":7.390566825866699}, "y":{"exp":"6.004539966583252 m", "val":6.004539966583252}, "heading":{"exp":"-0.8915152357196665 rad", "val":-0.8915152357196665}, "intervals":35, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"7.448474407196045 m", "val":7.448474407196045}, "y":{"exp":"4.726224899291992 m", "val":4.726224899291992}, "heading":{"exp":"-2.5646739792250837 rad", "val":-2.5646739792250837}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.469950199127197 m", "val":6.469950199127197}, "y":{"exp":"4.578090190887451 m", "val":4.578090190887451}, "heading":{"exp":"-3.1254652057435086 rad", "val":-3.1254652057435086}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.469950199127197 m", "val":6.469950199127197}, "y":{"exp":"4.578090190887451 m", "val":4.578090190887451}, "heading":{"exp":"-3.1254652057435086 rad", "val":-3.1254652057435086}, "intervals":23, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"6.04764461517334 m", "val":6.04764461517334}, "y":{"exp":"5.082523822784424 m", "val":5.082523822784424}, "heading":{"exp":"-2.594308272602356 rad", "val":-2.594308272602356}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"5.611854076385498 m", "val":5.611854076385498}, "y":{"exp":"5.705188274383545 m", "val":5.705188274383545}, "heading":{"exp":"-1.5644673676928553 rad", "val":-1.564467367692855}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":true}, - {"from":0, "to":6, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"3.75 m / s ^ 2", "val":3.75}}}, "enabled":true}, + {"from":0, "to":6, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"4 m / s ^ 2", "val":4.0}}}, "enabled":true}, {"from":0, "to":6, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"4 rad / s", "val":4.0}}}, "enabled":true}, {"from":3, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, @@ -73,195 +73,191 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,0.60792,1.18725,2.04733,3.0454,3.53304,4.18084], + "waypoints":[0.0,0.59657,1.16412,2.0081,3.0028,3.47503,4.1062], "samples":[ - {"t":0.0, "x":5.61185, "y":5.70519, "heading":-1.56572, "vx":0.55732, "vy":1.91599, "omega":2.88983, "ax":2.08514, "ay":-0.42515, "alpha":1.62458, "fx":[36.92913,29.21851,29.26595,36.99914], "fy":[-2.39537,-1.9506,-11.35649,-11.29594]}, - {"t":0.01788, "x":5.62215, "y":5.73938, "heading":-1.51405, "vx":0.5946, "vy":1.90839, "omega":2.91888, "ax":3.37145, "ay":-1.11131, "alpha":1.2399, "fx":[56.18923,50.69193,50.8689,56.34668], "fy":[-14.29406,-13.63866,-21.58742,-21.05125]}, - {"t":0.03576, "x":5.63332, "y":5.77332, "heading":-1.46186, "vx":0.65488, "vy":1.88852, "omega":2.94105, "ax":3.4193, "ay":-1.24975, "alpha":0.94714, "fx":[56.19287,52.10073,52.37816,56.46366], "fy":[-17.22686,-16.74327,-23.05253,-22.33996]}, - {"t":0.05364, "x":5.64558, "y":5.80689, "heading":-1.40927, "vx":0.71602, "vy":1.86618, "omega":2.95798, "ax":3.41079, "ay":-1.37499, "alpha":0.70612, "fx":[55.48139,52.50362,52.80717,55.80277], "fy":[-19.85189,-19.49277,-24.36116,-23.61035]}, - {"t":0.07152, "x":5.65893, "y":5.84004, "heading":-1.35638, "vx":0.777, "vy":1.84159, "omega":2.97061, "ax":3.38158, "ay":-1.49494, "alpha":0.50902, "fx":[54.56817,52.50767,52.77711,54.88703], "fy":[-22.36341,-21.91285,-25.67024,-24.98634]}, - {"t":0.0894, "x":5.67336, "y":5.87273, "heading":-1.30327, "vx":0.83746, "vy":1.81486, "omega":2.97971, "ax":3.34104, "ay":-1.61164, "alpha":0.34184, "fx":[53.57954,52.2626,52.466,53.85753], "fy":[-24.73047,-24.22683,-26.96664,-26.41968]}, - {"t":0.10728, "x":5.68887, "y":5.90492, "heading":-1.24999, "vx":0.8972, "vy":1.78605, "omega":2.98582, "ax":3.29274, "ay":-1.72576, "alpha":0.19499, "fx":[52.53268,51.86586,51.96754,52.73232], "fy":[-27.0446,-26.36621,-28.25998,-27.91975]}, - {"t":0.12516, "x":5.70543, "y":5.93658, "heading":-1.19661, "vx":0.95607, "vy":1.75519, "omega":2.98931, "ax":3.23834, "ay":-1.83752, "alpha":0.06639, "fx":[51.44564,51.3554,51.31677,51.52628], "fy":[-29.30008,-28.33369,-29.56927,-29.48487]}, - {"t":0.14304, "x":5.72305, "y":5.96766, "heading":-1.14316, "vx":1.01397, "vy":1.72233, "omega":2.9905, "ax":3.17875, "ay":-1.94698, "alpha":-0.06469, "fx":[50.3115,50.77157,50.55544,50.22163], "fy":[-31.48488,-30.33702,-30.78727,-31.02978]}, - {"t":0.16092, "x":5.74168, "y":5.99815, "heading":-1.08969, "vx":1.07081, "vy":1.68752, "omega":2.98934, "ax":3.11451, "ay":-2.05413, "alpha":-0.19038, "fx":[49.14115,50.13572,49.68417,48.81923], "fy":[-33.63645,-32.2038,-31.98947,-32.61378]}, - {"t":0.1788, "x":5.76133, "y":6.02799, "heading":-1.03624, "vx":1.1265, "vy":1.65079, "omega":2.98594, "ax":3.04592, "ay":-2.15897, "alpha":-0.32438, "fx":[47.92532,49.48861,48.72286,47.28813], "fy":[-35.7978,-33.95662,-33.12406,-34.22242]}, - {"t":0.19668, "x":5.78196, "y":6.05716, "heading":-0.98285, "vx":1.18096, "vy":1.61219, "omega":2.98014, "ax":2.97291, "ay":-2.26185, "alpha":-0.46644, "fx":[46.677,48.82976,47.65849,45.62336], "fy":[-37.93256,-35.65553,-34.19728,-35.84856]}, - {"t":0.21456, "x":5.80355, "y":6.08563, "heading":-0.92957, "vx":1.23411, "vy":1.57175, "omega":2.9718, "ax":2.89339, "ay":-2.36537, "alpha":-0.62699, "fx":[45.35982,48.16476,46.46155,43.75263], "fy":[-40.13189,-37.30498,-35.22302,-37.54825]}, - {"t":0.23244, "x":5.82608, "y":6.11335, "heading":-0.87643, "vx":1.28585, "vy":1.52946, "omega":2.96058, "ax":2.79533, "ay":-2.48259, "alpha":-0.80421, "fx":[43.8119,47.30912,44.91981,41.4706], "fy":[-42.54226,-39.15857,-36.4197,-39.53105]}, - {"t":0.25032, "x":5.84951, "y":6.1403, "heading":-0.8235, "vx":1.33583, "vy":1.48507, "omega":2.94621, "ax":2.64255, "ay":-2.64628, "alpha":-1.01149, "fx":[41.44658,45.75344,42.4439,38.16602], "fy":[-45.81511,-41.5512,-38.33549,-42.34464]}, - {"t":0.2682, "x":5.87382, "y":6.16643, "heading":-0.77082, "vx":1.38308, "vy":1.43775, "omega":2.92812, "ax":2.42266, "ay":-2.85031, "alpha":-1.25363, "fx":[38.11527,43.30218,38.81593,33.61292], "fy":[-49.75111,-44.57298,-40.79211,-45.88667]}, - {"t":0.28608, "x":5.89894, "y":6.19168, "heading":-0.71846, "vx":1.42639, "vy":1.38679, "omega":2.90571, "ax":2.18571, "ay":-3.03694, "alpha":-1.53602, "fx":[34.63581,40.79154,34.77841,28.59291], "fy":[-53.55461,-46.97684,-42.99762,-49.32565]}, - {"t":0.30396, "x":5.92479, "y":6.21599, "heading":-0.66651, "vx":1.46547, "vy":1.33249, "omega":2.87824, "ax":1.96373, "ay":-3.1859, "alpha":-1.86814, "fx":[31.55316,38.72764,30.8142,23.60789], "fy":[-56.78861,-48.85941,-44.44878,-52.21748]}, - {"t":0.32184, "x":5.95131, "y":6.23931, "heading":-0.61505, "vx":1.50058, "vy":1.27553, "omega":2.84484, "ax":1.76606, "ay":-3.30036, "alpha":-2.25142, "fx":[29.05077,37.25053,27.0331,18.81564], "fy":[-59.53179,-50.18341,-45.21561,-54.65188]}, - {"t":0.33972, "x":5.97842, "y":6.26159, "heading":-0.56418, "vx":1.53216, "vy":1.21652, "omega":2.80458, "ax":1.59324, "ay":-3.38783, "alpha":-2.69574, "fx":[27.16718,36.39363,23.40564,14.20874], "fy":[-61.93335,-51.03051,-45.38964,-56.78348]}, - {"t":0.3576, "x":6.00607, "y":6.2828, "heading":-0.51404, "vx":1.56065, "vy":1.15594, "omega":2.75638, "ax":1.44296, "ay":-3.45506, "alpha":-3.20612, "fx":[25.87209,36.1442,19.8413,9.77439], "fy":[-64.16,-51.24581,-45.18499,-58.8159]}, - {"t":0.37548, "x":6.0342, "y":6.30291, "heading":-0.46475, "vx":1.58645, "vy":1.09417, "omega":2.69906, "ax":1.31221, "ay":-3.50728, "alpha":-3.78848, "fx":[25.15444,36.47262,16.24468,5.45744], "fy":[-66.21568,-51.17464,-44.56519,-60.76692]}, - {"t":0.39336, "x":6.06278, "y":6.32192, "heading":-0.41649, "vx":1.60991, "vy":1.03146, "omega":2.63132, "ax":1.19808, "ay":-3.54829, "alpha":-4.44109, "fx":[24.97194,37.31951,12.52223,1.268], "fy":[-68.18182,-50.70341,-43.69072,-62.75095]}, - {"t":0.41124, "x":6.09176, "y":6.33979, "heading":-0.36945, "vx":1.63133, "vy":0.96801, "omega":2.55192, "ax":1.098, "ay":-3.58088, "alpha":-5.17087, "fx":[25.32198,38.62951,8.59152,-2.81711], "fy":[-70.10735,-49.89235,-42.56625,-64.83036]}, - {"t":0.42912, "x":6.1211, "y":6.35653, "heading":-0.32382, "vx":1.65096, "vy":0.90399, "omega":2.45946, "ax":1.00976, "ay":-3.60706, "alpha":-5.9663, "fx":[26.15643,40.34694,4.37982,-6.76016], "fy":[-71.94979,-48.88003,-41.24712,-66.9819]}, - {"t":0.447, "x":6.15078, "y":6.37211, "heading":-0.27984, "vx":1.66902, "vy":0.83949, "omega":2.35278, "ax":0.93157, "ay":-3.62831, "alpha":-6.83534, "fx":[27.41411,42.4738,-0.16941,-10.56084], "fy":[-73.78319,-47.43436,-39.87719,-69.3136]}, - {"t":0.46488, "x":6.18077, "y":6.38654, "heading":-0.23778, "vx":1.68568, "vy":0.77462, "omega":2.23057, "ax":0.86191, "ay":-3.64573, "alpha":-7.76039, "fx":[29.05493,44.91448,-5.08349,-14.15192], "fy":[-75.55641,-45.80536,-38.42338,-71.72914]}, - {"t":0.48276, "x":6.21105, "y":6.39981, "heading":-0.19789, "vx":1.70109, "vy":0.70944, "omega":2.09181, "ax":0.79954, "ay":-3.66012, "alpha":-8.74277, "fx":[30.97031,47.70239,-10.38478,-17.5146], "fy":[-77.32693,-43.66525,-37.14719,-74.28923]}, - {"t":0.50064, "x":6.24159, "y":6.41191, "heading":-0.16049, "vx":1.71538, "vy":0.64399, "omega":1.93549, "ax":0.74343, "ay":-3.67212, "alpha":-9.75713, "fx":[33.1714,50.66576,-16.033,-20.59421], "fy":[-78.98738,-41.52443,-35.80566,-76.87318]}, - {"t":0.51852, "x":6.27238, "y":6.42284, "heading":-0.12589, "vx":1.72867, "vy":0.57834, "omega":1.76104, "ax":0.69272, "ay":-3.6822, "alpha":-10.79816, "fx":[35.53958,53.81593,-21.98706,-23.37862], "fy":[-80.58777,-39.12453,-34.62024,-79.4979]}, - {"t":0.5364, "x":6.3034, "y":6.43259, "heading":-0.0944, "vx":1.74106, "vy":0.5125, "omega":1.56797, "ax":0.6467, "ay":-3.69072, "alpha":-11.84753, "fx":[37.9855,57.0967,-28.14607,-25.86849], "fy":[-82.11253,-36.60538,-33.56688,-82.08645]}, - {"t":0.55428, "x":6.33463, "y":6.44116, "heading":-0.06636, "vx":1.75262, "vy":0.44651, "omega":1.35614, "ax":0.60478, "ay":-3.69796, "alpha":-12.89086, "fx":[40.46537,60.43772,-34.4093,-28.08827], "fy":[-83.54676,-34.06666,-32.61551,-84.60225]}, - {"t":0.57216, "x":6.36607, "y":6.44856, "heading":-0.04212, "vx":1.76344, "vy":0.38039, "omega":1.12565, "ax":0.56645, "ay":-3.70415, "alpha":-13.91413, "fx":[42.90213,63.79429,-40.65648,-30.06844], "fy":[-84.90064,-31.66927,-31.64967,-87.00498]}, - {"t":0.59004, "x":6.39769, "y":6.45477, "heading":-0.02199, "vx":1.77356, "vy":0.31416, "omega":0.87686, "ax":0.53129, "ay":-3.70948, "alpha":-14.90969, "fx":[45.15854,67.18722,-46.73907,-31.86792], "fy":[-86.24487,-29.19714,-30.834,-89.2867]}, - {"t":0.60792, "x":6.42948, "y":6.45979, "heading":-0.00631, "vx":1.78306, "vy":0.24783, "omega":0.61028, "ax":0.49732, "ay":-3.71189, "alpha":-14.82453, "fx":[44.84903,65.81589,-47.67985,-31.40389], "fy":[-85.91064,-28.66983,-31.7111,-89.4242]}, - {"t":0.62723, "x":6.46401, "y":6.46388, "heading":0.00547, "vx":1.79267, "vy":0.17615, "omega":0.324, "ax":0.45902, "ay":-3.71919, "alpha":-13.88693, "fx":[42.9227,60.66534,-44.56693,-29.87202], "fy":[-84.10834,-30.41097,-34.01992,-87.64026]}, - {"t":0.64654, "x":6.49871, "y":6.46659, "heading":0.01173, "vx":1.80153, "vy":0.10433, "omega":0.05583, "ax":0.41649, "ay":-3.72406, "alpha":-12.99884, "fx":[40.62915,55.81255,-41.5778,-28.4156], "fy":[-82.64954,-32.17775,-35.73413,-85.9275]}, - {"t":0.66585, "x":6.53358, "y":6.46791, "heading":0.01281, "vx":1.80957, "vy":0.03242, "omega":-0.19519, "ax":0.36947, "ay":-3.72888, "alpha":-12.10142, "fx":[38.03504,51.04963,-38.52181,-27.10043], "fy":[-81.30078,-34.17382,-37.22897,-84.09117]}, - {"t":0.68516, "x":6.56859, "y":6.46784, "heading":0.00904, "vx":1.81671, "vy":-0.03959, "omega":-0.42888, "ax":0.31725, "ay":-3.73353, "alpha":-11.2051, "fx":[35.19269,46.40254,-35.51039,-25.93837], "fy":[-80.03187,-36.32594,-38.57847,-82.15359]}, - {"t":0.70447, "x":6.60374, "y":6.46638, "heading":0.00076, "vx":1.82284, "vy":-0.11169, "omega":-0.64526, "ax":0.25898, "ay":-3.73785, "alpha":-10.32041, "fx":[32.0747,41.87181,-32.60409,-24.89652], "fy":[-78.87334,-38.41223,-39.89267,-80.18593]}, - {"t":0.72378, "x":6.63898, "y":6.46353, "heading":-0.0117, "vx":1.82784, "vy":-0.18387, "omega":-0.84456, "ax":0.19359, "ay":-3.74161, "alpha":-9.45385, "fx":[28.79236,37.45356,-29.93032,-24.02193], "fy":[-77.74066,-40.63011,-41.06598,-78.16627]}, - {"t":0.74309, "x":6.67432, "y":6.45928, "heading":-0.02801, "vx":1.83158, "vy":-0.25613, "omega":-1.02712, "ax":0.1198, "ay":-3.74448, "alpha":-8.60784, "fx":[25.34257,33.08112,-27.51214,-23.30407], "fy":[-76.63062,-42.85587,-42.1641,-76.1347]}, - {"t":0.7624, "x":6.70971, "y":6.45364, "heading":-0.04785, "vx":1.83389, "vy":-0.32844, "omega":-1.19335, "ax":0.03599, "ay":-3.74597, "alpha":-7.79811, "fx":[21.74168,28.7713,-25.45506,-22.77253], "fy":[-75.55106,-44.96521,-43.22345,-74.14056]}, - {"t":0.78172, "x":6.74513, "y":6.4466, "heading":-0.07089, "vx":1.83458, "vy":-0.40077, "omega":-1.34394, "ax":-0.05984, "ay":-3.74539, "alpha":-7.02308, "fx":[17.99706,24.45681,-23.79821,-22.45537], "fy":[-74.45843,-46.98219,-44.22544,-72.17704]}, - {"t":0.80103, "x":6.78055, "y":6.43816, "heading":-0.09684, "vx":1.83343, "vy":-0.4731, "omega":-1.47956, "ax":-0.17017, "ay":-3.74168, "alpha":-6.28964, "fx":[14.08799,20.08476,-22.60078,-22.37857], "fy":[-73.34898,-48.7731,-45.19337,-70.292]}, - {"t":0.82034, "x":6.81592, "y":6.42832, "heading":-0.12542, "vx":1.83014, "vy":-0.54536, "omega":-1.60102, "ax":-0.29816, "ay":-3.73329, "alpha":-5.60391, "fx":[10.02781,15.61973,-21.94151,-22.63976], "fy":[-72.20228,-50.41517,-46.02992,-68.42738]}, - {"t":0.83965, "x":6.85121, "y":6.4171, "heading":-0.15633, "vx":1.82438, "vy":-0.61745, "omega":-1.70924, "ax":-0.44765, "ay":-3.7179, "alpha":-4.956, "fx":[5.72586,10.93755,-21.83518,-23.255], "fy":[-70.95194,-51.71561,-46.83025,-66.59947]}, - {"t":0.85896, "x":6.88635, "y":6.40448, "heading":-0.18934, "vx":1.81574, "vy":-0.68925, "omega":-1.80494, "ax":-0.62332, "ay":-3.692, "alpha":-4.36597, "fx":[1.16738,6.02874,-22.42454,-24.3541], "fy":[-69.59937,-52.60463,-47.4585,-64.79045]}, - {"t":0.87827, "x":6.9213, "y":6.39048, "heading":-0.2242, "vx":1.8037, "vy":-0.76054, "omega":-1.88926, "ax":-0.83046, "ay":-3.6504, "alpha":-3.80861, "fx":[-3.76866,0.69562,-23.69416,-25.96922], "fy":[-67.99947,-53.08106,-47.8496,-62.88069]}, - {"t":0.89758, "x":6.95598, "y":6.37511, "heading":-0.26068, "vx":1.78767, "vy":-0.83104, "omega":-1.9628, "ax":-1.07394, "ay":-3.58561, "alpha":-3.29963, "fx":[-9.109,-5.03132,-25.80321,-28.25464], "fy":[-66.02731,-53.18063,-47.76643,-60.7225]}, - {"t":0.91689, "x":6.9903, "y":6.3584, "heading":-0.29858, "vx":1.76693, "vy":-0.90028, "omega":-2.02652, "ax":-1.35466, "ay":-3.4884, "alpha":-2.82065, "fx":[-14.93571,-11.28387,-28.64897,-31.15662], "fy":[-63.54946,-52.52393,-47.21981,-58.23031]}, - {"t":0.9362, "x":7.02417, "y":6.34036, "heading":-0.33772, "vx":1.74077, "vy":-0.96764, "omega":-2.08099, "ax":-1.65749, "ay":-3.3541, "alpha":-2.38975, "fx":[-20.9556,-17.7128,-32.06679,-34.52006], "fy":[-60.5107,-51.12703,-46.04292,-55.31455]}, - {"t":0.95552, "x":7.05748, "y":6.32105, "heading":-0.3779, "vx":1.70876, "vy":-1.03241, "omega":-2.12714, "ax":-1.9212, "ay":-3.20913, "alpha":-1.9783, "fx":[-26.26314,-23.4323,-34.98663,-37.31995], "fy":[-57.22879,-49.4473,-44.74298,-52.37004]}, - {"t":0.97483, "x":7.09012, "y":6.30051, "heading":-0.41898, "vx":1.67166, "vy":-1.09439, "omega":-2.16535, "ax":-2.0883, "ay":-3.10153, "alpha":-1.60314, "fx":[-29.88989,-27.43409,-36.56948,-38.72], "fy":[-54.48107,-48.38849,-43.97758,-50.10939]}, - {"t":0.99414, "x":7.12201, "y":6.2788, "heading":-0.4608, "vx":1.63133, "vy":-1.15428, "omega":-2.1963, "ax":-2.2084, "ay":-3.01541, "alpha":-1.24788, "fx":[-32.66996,-30.63457,-37.52298,-39.41205], "fy":[-52.10442,-47.29497,-43.69495,-48.39309]}, - {"t":1.01345, "x":7.1531, "y":6.25595, "heading":-0.50321, "vx":1.58869, "vy":-1.21251, "omega":-2.2204, "ax":-2.31654, "ay":-2.93089, "alpha":-0.91795, "fx":[-35.12915,-33.54551,-38.44584,-39.98664], "fy":[-49.7603,-46.14022,-43.41647,-46.80307]}, - {"t":1.03276, "x":7.18335, "y":6.23199, "heading":-0.54609, "vx":1.54395, "vy":-1.26911, "omega":-2.23813, "ax":-2.41993, "ay":-2.84322, "alpha":-0.59471, "fx":[-37.42107,-36.34595,-39.4041,-40.50177], "fy":[-47.31584,-44.8733,-43.11179,-45.25218]}, - {"t":1.05207, "x":7.21271, "y":6.20695, "heading":-0.58931, "vx":1.49722, "vy":-1.32401, "omega":-2.24961, "ax":-2.51935, "ay":-2.75172, "alpha":-0.28397, "fx":[-39.53887,-39.03628,-40.42736,-40.9839], "fy":[-44.80328,-43.46391,-42.7438,-43.73153]}, - {"t":1.07138, "x":7.24115, "y":6.18087, "heading":-0.63275, "vx":1.44857, "vy":-1.37715, "omega":-2.2551, "ax":-2.61459, "ay":-2.65631, "alpha":0.02687, "fx":[-41.50044,-41.65543,-41.48582,-41.3923], "fy":[-42.18976,-41.88964,-42.3551,-42.24904]}, - {"t":1.09069, "x":7.26864, "y":6.15378, "heading":-0.6763, "vx":1.39808, "vy":-1.42845, "omega":-2.25458, "ax":-2.70518, "ay":-2.55693, "alpha":0.33785, "fx":[-43.29356,-44.1886,-42.58195,-41.72302], "fy":[-39.45012,-40.25303,-41.90125,-40.76843]}, - {"t":1.11, "x":7.29513, "y":6.12572, "heading":-0.71984, "vx":1.34584, "vy":-1.47783, "omega":-2.24805, "ax":-2.79044, "ay":-2.45345, "alpha":0.65699, "fx":[-44.91236,-46.65495,-43.69392,-41.94017], "fy":[-36.58497,-38.45934,-41.43385,-39.32289]}, - {"t":1.12931, "x":7.3206, "y":6.09672, "heading":-0.76325, "vx":1.29195, "vy":-1.5252, "omega":-2.23537, "ax":-2.8692, "ay":-2.34547, "alpha":0.98824, "fx":[-46.33239,-49.04577,-44.80743,-42.01717], "fy":[-33.58684,-36.47959,-40.96017,-37.91749]}, - {"t":1.14863, "x":7.34502, "y":6.06683, "heading":-0.80642, "vx":1.23654, "vy":-1.5705, "omega":-2.21628, "ax":-2.93947, "ay":-2.23178, "alpha":1.33762, "fx":[-47.51834,-51.33778,-45.89646,-41.91268], "fy":[-30.39982,-34.32715,-40.4693,-36.52799]}, - {"t":1.16794, "x":7.36835, "y":6.03609, "heading":-0.84922, "vx":1.17978, "vy":-1.6136, "omega":-2.19045, "ax":-3.01954, "ay":-2.07653, "alpha":1.70927, "fx":[-48.74264,-53.80652,-47.27189,-41.92857], "fy":[-26.40168,-31.48205,-39.41116,-34.57056]}, - {"t":1.18725, "x":7.39057, "y":6.00454, "heading":-0.89152, "vx":1.12147, "vy":-1.6537, "omega":-2.15744, "ax":-2.94427, "ay":-1.95897, "alpha":0.89817, "fx":[-46.90438,-49.91072,-46.61293,-43.5417], "fy":[-27.73044,-30.29517,-34.42693,-31.94793]}, - {"t":1.21114, "x":7.41652, "y":5.96447, "heading":-0.94306, "vx":1.05113, "vy":-1.7005, "omega":-2.13598, "ax":-3.06591, "ay":-1.80678, "alpha":0.77171, "fx":[-48.70325,-51.31489,-48.68394,-45.99204], "fy":[-25.69316,-27.94944,-31.5492,-29.54414]}, - {"t":1.23503, "x":7.44076, "y":5.92333, "heading":-0.99409, "vx":0.97788, "vy":-1.74366, "omega":-2.11755, "ax":-2.94862, "ay":-1.5774, "alpha":0.69019, "fx":[-46.67373,-49.14911,-46.98095,-44.44211], "fy":[-22.35835,-24.33139,-27.58574,-25.89394]}, - {"t":1.25892, "x":7.46328, "y":5.88122, "heading":-1.04468, "vx":0.90743, "vy":-1.78135, "omega":-2.10106, "ax":-2.24332, "ay":-1.10077, "alpha":0.61606, "fx":[-35.32619,-37.71943,-35.92565,-33.48642], "fy":[-14.96521,-17.08224,-19.64728,-18.20743]}, - {"t":1.28281, "x":7.48432, "y":5.83835, "heading":-1.09488, "vx":0.85384, "vy":-1.80765, "omega":-2.08634, "ax":-1.36688, "ay":-0.6308, "alpha":0.53697, "fx":[-21.31512,-23.56237,-22.09897,-19.82448], "fy":[-7.66755,-9.9716,-11.80222,-10.61597]}, - {"t":1.3067, "x":7.50433, "y":5.79498, "heading":-1.14472, "vx":0.82118, "vy":-1.82272, "omega":-2.07351, "ax":-0.9452, "ay":-0.41891, "alpha":0.46545, "fx":[-14.56836,-16.62138,-15.44965,-13.38371], "fy":[-4.54878,-6.69749,-8.15087,-7.20471]}, - {"t":1.33059, "x":7.52368, "y":5.75132, "heading":-1.19426, "vx":0.7986, "vy":-1.83273, "omega":-2.06239, "ax":-1.01944, "ay":-0.43626, "alpha":0.41099, "fx":[-15.72498,-17.56942,-16.64318,-14.79961], "fy":[-5.15759,-6.74748,-8.26574,-7.53301]}, - {"t":1.35449, "x":7.54246, "y":5.7074, "heading":-1.24353, "vx":0.77424, "vy":-1.84315, "omega":-2.05257, "ax":-1.63237, "ay":-0.66547, "alpha":0.37276, "fx":[-25.46081,-27.08356,-26.36414,-24.7518], "fy":[-9.1852,-9.9406,-11.83979,-11.29353]}, - {"t":1.37838, "x":7.5605, "y":5.66318, "heading":-1.29257, "vx":0.73524, "vy":-1.85905, "omega":-2.04367, "ax":-2.73251, "ay":-1.02562, "alpha":0.34476, "fx":[-42.95955,-44.34572,-43.79003,-42.42692], "fy":[-15.30203,-15.13729,-17.53574,-17.15452]}, - {"t":1.40227, "x":7.57728, "y":5.61847, "heading":-1.3414, "vx":0.66996, "vy":-1.88355, "omega":-2.03543, "ax":-3.27433, "ay":-1.08895, "alpha":0.31001, "fx":[-51.60307,-52.77514,-52.34192,-51.20923], "fy":[-16.56255,-15.96544,-18.43606,-18.18733]}, - {"t":1.42616, "x":7.59235, "y":5.57316, "heading":-1.39003, "vx":0.59173, "vy":-1.90957, "omega":-2.02802, "ax":-3.4578, "ay":-0.99011, "alpha":0.27685, "fx":[-54.54236,-55.55448,-55.22623,-54.25714], "fy":[-15.13223,-14.42894,-16.7354,-16.57843]}, - {"t":1.45005, "x":7.6055, "y":5.52726, "heading":-1.43848, "vx":0.50912, "vy":-1.93322, "omega":-2.02141, "ax":-3.55764, "ay":-0.8536, "alpha":0.25032, "fx":[-56.14641,-57.0324,-56.79397,-55.94803], "fy":[-13.06229,-12.31693,-14.45863,-14.36824]}, - {"t":1.47394, "x":7.61665, "y":5.48083, "heading":-1.48677, "vx":0.42413, "vy":-1.95362, "omega":-2.01543, "ax":-3.62229, "ay":-0.70227, "alpha":0.23746, "fx":[-57.18403,-57.96988,-57.81188,-57.06006], "fy":[-10.76623,-9.85135,-12.01153,-11.96717]}, - {"t":1.49783, "x":7.62575, "y":5.43395, "heading":-1.53492, "vx":0.33759, "vy":-1.97039, "omega":-2.00976, "ax":-3.66876, "ay":-0.53388, "alpha":0.23186, "fx":[-57.92129,-58.62087,-58.5593,-57.87562], "fy":[-8.17593,-7.0946,-9.32777,-9.30476]}, - {"t":1.52172, "x":7.63277, "y":5.38672, "heading":-1.58294, "vx":0.24994, "vy":-1.98315, "omega":-2.00422, "ax":-3.70981, "ay":0.26035, "alpha":0.20733, "fx":[-58.53998,-59.17692,-59.26012,-58.60684], "fy":[4.50345,5.22407,3.3839,3.42149]}, - {"t":1.54562, "x":7.63768, "y":5.33942, "heading":-1.63082, "vx":0.1613, "vy":-1.97693, "omega":-1.99926, "ax":-3.17799, "ay":1.95355, "alpha":0.16406, "fx":[-50.00272,-50.71769,-50.89312,-50.19836], "fy":[31.58696,31.42843,30.48988,30.55108]}, - {"t":1.56951, "x":7.64063, "y":5.29275, "heading":-1.67859, "vx":0.08538, "vy":-1.93026, "omega":-1.99534, "ax":-2.70457, "ay":2.57862, "alpha":0.16261, "fx":[-42.39108,-43.23162,-43.45038,-42.67503], "fy":[41.55828,41.20325,40.46976,40.51844]}, - {"t":1.5934, "x":7.6419, "y":5.24736, "heading":-1.72626, "vx":0.02076, "vy":-1.86865, "omega":-1.99146, "ax":-2.42024, "ay":2.85167, "alpha":0.18756, "fx":[-37.77176,-38.73647,-39.03704,-38.14678], "fy":[45.88807,45.66774,44.75803,44.77587]}, - {"t":1.61729, "x":7.6417, "y":5.20353, "heading":-1.77384, "vx":-0.03706, "vy":-1.80052, "omega":-1.98698, "ax":-2.24045, "ay":2.99756, "alpha":0.20752, "fx":[-34.77776,-35.91731,-36.31103,-35.26892], "fy":[48.29523,47.94027,47.07398,47.04422]}, - {"t":1.64118, "x":7.64018, "y":5.16137, "heading":-1.82131, "vx":-0.09059, "vy":-1.72891, "omega":-1.98202, "ax":-2.11839, "ay":3.08667, "alpha":0.25592, "fx":[-32.66958,-33.99003,-34.55033,-33.31385], "fy":[49.73885,49.58768,48.39105,48.29488]}, - {"t":1.66507, "x":7.63741, "y":5.12095, "heading":-1.86866, "vx":-0.1412, "vy":-1.65516, "omega":-1.9759, "ax":-2.03063, "ay":3.14623, "alpha":0.3073, "fx":[-31.06072,-32.60624,-33.37757,-31.90628], "fy":[50.76596,50.69561,49.26059,49.07274]}, - {"t":1.68896, "x":7.63346, "y":5.0823, "heading":-1.91587, "vx":-0.18971, "vy":-1.57999, "omega":-1.96856, "ax":-1.96468, "ay":3.18866, "alpha":0.37612, "fx":[-29.75134,-31.55043,-32.6038,-30.85745], "fy":[51.51146,51.6385,49.82632,49.51282]}, - {"t":1.71285, "x":7.62836, "y":5.04547, "heading":-1.9629, "vx":-0.23665, "vy":-1.50381, "omega":-1.95958, "ax":-1.91339, "ay":3.22033, "alpha":0.45119, "fx":[-28.60622,-30.75698,-32.1007,-30.04209], "fy":[52.12366,52.3619,50.24586,49.76886]}, - {"t":1.73674, "x":7.62216, "y":5.01046, "heading":-2.00971, "vx":-0.28236, "vy":-1.42688, "omega":-1.9488, "ax":-1.8724, "ay":3.24483, "alpha":0.54448, "fx":[-27.57542,-30.07302,-31.83199,-29.42232], "fy":[52.60771,53.07894,50.52947,49.84026]}, - {"t":1.76064, "x":7.61488, "y":4.97729, "heading":-2.05627, "vx":-0.3271, "vy":-1.34935, "omega":-1.93579, "ax":-1.8389, "ay":3.26433, "alpha":0.6505, "fx":[-26.59648,-29.48984,-31.74341,-28.94589], "fy":[53.0208,53.73878,50.7446,49.79057]}, - {"t":1.78453, "x":7.60654, "y":4.94599, "heading":-2.10252, "vx":-0.37103, "vy":-1.27137, "omega":-1.92025, "ax":-1.81103, "ay":3.28021, "alpha":0.77476, "fx":[-25.63437,-28.9602,-31.81217,-28.59881], "fy":[53.37126,54.4104,50.9071,49.61424]}, - {"t":1.80842, "x":7.59716, "y":4.91655, "heading":-2.1484, "vx":-0.4143, "vy":-1.193, "omega":-1.90174, "ax":-1.78748, "ay":3.29338, "alpha":0.9162, "fx":[-24.66484,-28.45085,-32.02745,-28.36684], "fy":[53.67534,55.08499,51.04261,49.3364]}, - {"t":1.83231, "x":7.58675, "y":4.88899, "heading":-2.19383, "vx":-0.457, "vy":-1.11431, "omega":-1.87985, "ax":-1.76732, "ay":3.30448, "alpha":1.08747, "fx":[-23.6684,-27.92519,-32.38441,-28.25187], "fy":[53.90381,55.89146,51.1303,48.91845]}, - {"t":1.8562, "x":7.57533, "y":4.86331, "heading":-2.23875, "vx":-0.49923, "vy":-1.03537, "omega":-1.85387, "ax":-1.74987, "ay":3.31395, "alpha":1.26718, "fx":[-22.60488,-27.43016,-32.85428,-28.23265], "fy":[54.14287,56.57877,51.2711,48.45293]}, - {"t":1.88009, "x":7.5629, "y":4.83952, "heading":-2.28304, "vx":-0.54103, "vy":-0.95619, "omega":-1.82359, "ax":-1.73463, "ay":3.32213, "alpha":1.48283, "fx":[-21.48001,-26.87339,-33.46236,-28.33804], "fy":[54.30267,57.43472,51.3857,47.84216]}, - {"t":1.90398, "x":7.54948, "y":4.81762, "heading":-2.3266, "vx":-0.58247, "vy":-0.87682, "omega":-1.78817, "ax":-1.72119, "ay":3.32927, "alpha":1.72833, "fx":[-20.26835,-26.25388,-34.2103,-28.56805], "fy":[54.4262,58.36414,51.50029,47.12775]}, - {"t":1.92787, "x":7.53508, "y":4.79762, "heading":-2.36933, "vx":-0.6236, "vy":-0.79728, "omega":-1.74688, "ax":-1.70926, "ay":3.33555, "alpha":2.00149, "fx":[-18.95997,-25.5815,-35.07016,-28.93143], "fy":[54.47917,59.34328,51.68815,46.30637]}, - {"t":1.95177, "x":7.51969, "y":4.77953, "heading":-2.41106, "vx":-0.66443, "vy":-0.71759, "omega":-1.69906, "ax":-1.6986, "ay":3.34111, "alpha":2.31577, "fx":[-17.53113,-24.80754,-36.06965,-29.45768], "fy":[54.49367,60.44245,51.90233,45.33184]}, - {"t":1.97566, "x":7.50333, "y":4.76334, "heading":-2.45165, "vx":-0.70501, "vy":-0.63777, "omega":-1.64373, "ax":-1.68901, "ay":3.34608, "alpha":2.66637, "fx":[-15.96491,-23.95246,-37.19542,-30.14451], "fy":[54.45625,61.60967,52.17983,44.23983]}, - {"t":1.99955, "x":7.48601, "y":4.74905, "heading":-2.49092, "vx":-0.74537, "vy":-0.55783, "omega":-1.58003, "ax":-1.68035, "ay":3.35053, "alpha":3.06097, "fx":[-14.24962,-22.98564,-38.45383,-31.01804], "fy":[54.35291,62.89052,52.51975,43.00548]}, - {"t":2.02344, "x":7.46772, "y":4.73668, "heading":-2.52867, "vx":-0.78551, "vy":-0.47778, "omega":-1.5069, "ax":-1.67248, "ay":3.35456, "alpha":3.50251, "fx":[-12.36809,-21.89829,-39.84494,-32.09614], "fy":[54.18241,64.2836,52.93328,41.62488]}, - {"t":2.04733, "x":7.44847, "y":4.72622, "heading":-2.56467, "vx":-0.82547, "vy":-0.39764, "omega":-1.42322, "ax":-1.72622, "ay":3.32545, "alpha":3.26948, "fx":[-14.38041,-22.66792,-39.61557,-32.95626], "fy":[53.25622,63.1274,52.92096,41.87122]}, - {"t":2.07852, "x":7.42189, "y":4.71544, "heading":-2.60906, "vx":-0.87931, "vy":-0.29392, "omega":-1.32124, "ax":-2.09669, "ay":3.10401, "alpha":2.80508, "fx":[-22.54151,-28.72391,-43.39476,-38.48554], "fy":[49.28414,58.43144,49.63009,39.76803]}, - {"t":2.10971, "x":7.39344, "y":4.70778, "heading":-2.65027, "vx":-0.94471, "vy":-0.1971, "omega":-1.23375, "ax":-1.6187, "ay":3.28738, "alpha":2.47352, "fx":[-16.19218,-21.46682,-34.70103,-30.43221], "fy":[51.65167,59.95392,53.14683,44.00572]}, - {"t":2.1409, "x":7.36319, "y":4.70323, "heading":-2.68875, "vx":-0.99519, "vy":-0.09457, "omega":-1.15661, "ax":0.07932, "ay":-0.74581, "alpha":2.79452, "fx":[11.07887,5.18294,-8.52711,-2.69759], "fy":[-14.60557,-1.99724,-9.39654,-21.36191]}, - {"t":2.17209, "x":7.33219, "y":4.69992, "heading":-2.72483, "vx":-0.99272, "vy":-0.11783, "omega":-1.06945, "ax":0.04847, "ay":-0.38814, "alpha":2.36206, "fx":[9.09952,4.42771,-7.58121,-2.86788], "fy":[-8.70859,1.72114,-3.61257,-14.04775]}, - {"t":2.20328, "x":7.30125, "y":4.69606, "heading":-2.75818, "vx":-0.99121, "vy":-0.12994, "omega":-0.99577, "ax":0.01767, "ay":-0.13266, "alpha":2.00835, "fx":[7.35057,3.64252,-6.81118,-3.05957], "fy":[-4.44412,4.32647,0.38377,-8.69066]}, - {"t":2.23447, "x":7.27034, "y":4.69194, "heading":-2.78924, "vx":-0.99065, "vy":-0.13407, "omega":-0.93313, "ax":0.00779, "ay":-0.05717, "alpha":1.73078, "fx":[6.16037,3.19792,-5.92801,-2.93559], "fy":[-3.09264,4.50959,1.4483,-6.49549]}, - {"t":2.26566, "x":7.23945, "y":4.68773, "heading":-2.81835, "vx":-0.99041, "vy":-0.13586, "omega":-0.87915, "ax":0.00716, "ay":-0.05187, "alpha":1.50646, "fx":[5.30074,2.92159,-5.08249,-2.68523], "fy":[-2.87876,3.82915,1.37317,-5.61755]}, - {"t":2.29685, "x":7.20856, "y":4.68347, "heading":-2.84577, "vx":-0.99019, "vy":-0.13748, "omega":-0.83216, "ax":0.00809, "ay":-0.05789, "alpha":1.32413, "fx":[4.62324,2.70092,-4.3715,-2.43884], "fy":[-2.85695,3.13217,1.1218,-5.07322]}, - {"t":2.32804, "x":7.17768, "y":4.67915, "heading":-2.87172, "vx":-0.98994, "vy":-0.13928, "omega":-0.79087, "ax":0.00833, "ay":-0.05883, "alpha":1.17591, "fx":[4.06631,2.5027,-3.80464,-2.23523], "fy":[-2.76535,2.63302,0.96696,-4.57032]}, - {"t":2.35923, "x":7.14681, "y":4.67478, "heading":-2.89639, "vx":-0.98968, "vy":-0.14112, "omega":-0.75419, "ax":0.00788, "ay":-0.05493, "alpha":1.05909, "fx":[3.61671,2.33221,-3.36816,-2.08034], "fy":[-2.61534,2.3136,0.91396,-4.10015]}, - {"t":2.39042, "x":7.11595, "y":4.67035, "heading":-2.91991, "vx":-0.98943, "vy":-0.14283, "omega":-0.72116, "ax":0.0072, "ay":-0.04961, "alpha":0.96945, "fx":[3.26437,2.19698,-3.03673,-1.96735], "fy":[-2.46417,2.10234,0.91116,-3.69958]}, - {"t":2.42161, "x":7.08509, "y":4.66587, "heading":-2.9424, "vx":-0.98921, "vy":-0.14438, "omega":-0.69092, "ax":0.00662, "ay":-0.04513, "alpha":0.90604, "fx":[3.007,2.10653,-2.79747,-1.89569], "fy":[-2.35459,1.95878,0.92814,-3.39823]}, - {"t":2.4528, "x":7.05424, "y":4.66135, "heading":-2.96395, "vx":-0.989, "vy":-0.14578, "omega":-0.66266, "ax":0.00625, "ay":-0.04219, "alpha":0.86626, "fx":[2.8351,2.06311,-2.6372,-1.86423], "fy":[-2.29973,1.86039,0.95544,-3.19549]}, - {"t":2.48399, "x":7.0234, "y":4.65678, "heading":-2.98462, "vx":-0.9888, "vy":-0.1471, "omega":-0.63564, "ax":0.00607, "ay":-0.04061, "alpha":0.84997, "fx":[2.74456,2.07078,-2.55229,-1.87767], "fy":[-2.30236,1.80736,1.00082,-3.08496]}, - {"t":2.51518, "x":6.99256, "y":4.65217, "heading":-3.00445, "vx":-0.98862, "vy":-0.14837, "omega":-0.60913, "ax":0.00602, "ay":-0.03997, "alpha":0.85626, "fx":[2.72905,2.13114,-2.53814,-1.93944], "fy":[-2.3589,1.80027,1.074,-3.05387]}, - {"t":2.54637, "x":6.96173, "y":4.64753, "heading":-3.02345, "vx":-0.98843, "vy":-0.14961, "omega":-0.58242, "ax":0.00608, "ay":-0.03998, "alpha":0.88559, "fx":[2.78653,2.24838,-2.59398,-2.05499], "fy":[-2.47004,1.84239,1.18461,-3.09588]}, - {"t":2.57756, "x":6.9309, "y":4.64284, "heading":-3.04161, "vx":-0.98824, "vy":-0.15086, "omega":-0.5548, "ax":0.00623, "ay":-0.04062, "alpha":0.93885, "fx":[2.91709,2.42816,-2.71987,-2.22995], "fy":[-2.64117,1.93331,1.33865,-3.21003]}, - {"t":2.60875, "x":6.90008, "y":4.63811, "heading":-3.05892, "vx":-0.98804, "vy":-0.15213, "omega":-0.52552, "ax":0.00652, "ay":-0.04214, "alpha":1.01706, "fx":[3.12208,2.67702,-2.91583,-2.46946], "fy":[-2.88199,2.06867,1.53769,-3.40011]}, - {"t":2.63994, "x":6.86927, "y":4.63335, "heading":-3.07531, "vx":-0.98784, "vy":-0.15344, "omega":-0.4938, "ax":0.00701, "ay":-0.04493, "alpha":1.12293, "fx":[3.40787,3.00559,-3.18622,-2.78197], "fy":[-3.20787,2.24672,1.78468,-3.67684]}, - {"t":2.67113, "x":6.83846, "y":4.62854, "heading":-3.09071, "vx":-0.98762, "vy":-0.15484, "omega":-0.45877, "ax":0.00775, "ay":-0.04919, "alpha":1.25828, "fx":[3.77831,3.42228,-3.53387,-3.17449], "fy":[-3.62842,2.46571,2.08376,-4.04477]}, - {"t":2.70232, "x":6.80766, "y":4.62369, "heading":-3.10502, "vx":-0.98738, "vy":-0.15638, "omega":-0.41953, "ax":0.00865, "ay":-0.05429, "alpha":1.42758, "fx":[4.24239,3.93972,-3.97102,-3.66209], "fy":[-4.14646,2.74469,2.45772,-4.50334]}, - {"t":2.7335, "x":6.77687, "y":4.61878, "heading":-3.1181, "vx":-0.98711, "vy":-0.15807, "omega":-0.375, "ax":0.00937, "ay":-0.05816, "alpha":1.6338, "fx":[4.80179,4.56375,-4.51045,-4.26015], "fy":[-4.73736,3.11969,2.94844,-5.02441]}, - {"t":2.76469, "x":6.74608, "y":4.61383, "heading":-3.1298, "vx":-0.98682, "vy":-0.15988, "omega":-0.32405, "ax":0.0094, "ay":-0.05769, "alpha":1.88304, "fx":[5.46343,5.30482,-5.17707,-4.99424], "fy":[-5.36642,3.65442,3.62099,-5.57229]}, - {"t":2.79588, "x":6.71531, "y":4.60881, "heading":-3.13991, "vx":-0.98652, "vy":-0.16168, "omega":-0.26531, "ax":0.00868, "ay":-0.0527, "alpha":2.18003, "fx":[6.23811,6.17747,-5.98571,-5.8785], "fy":[-6.04172,4.36387,4.48702,-6.15599]}, - {"t":2.82707, "x":6.68455, "y":4.60374, "heading":3.135, "vx":-0.98625, "vy":-0.16333, "omega":-0.19732, "ax":0.00978, "ay":-0.05869, "alpha":2.53397, "fx":[7.18809,7.24553,-6.91988,-6.89297], "fy":[-7.03223,5.04261,5.31227,-7.04981]}, - {"t":2.85826, "x":6.65379, "y":4.59862, "heading":3.12885, "vx":-0.98595, "vy":-0.16516, "omega":-0.11829, "ax":0.02227, "ay":-0.13125, "alpha":2.95746, "fx":[8.49279,8.68093,-7.85348,-7.90632], "fy":[-9.26129,4.89235,5.21886,-9.18454]}, - {"t":2.88945, "x":6.62305, "y":4.5934, "heading":3.12516, "vx":-0.98525, "vy":-0.16925, "omega":-0.02604, "ax":0.06636, "ay":-0.3731, "alpha":3.47333, "fx":[10.5312,10.81664,-8.50024,-8.63334], "fy":[-14.44901,2.45288,2.5834,-14.28017]}, - {"t":2.92064, "x":6.59235, "y":4.58794, "heading":3.12435, "vx":-0.98318, "vy":-0.18089, "omega":0.08229, "ax":0.13565, "ay":-0.6942, "alpha":4.07165, "fx":[13.27831,13.44667,-8.89918,-9.21186], "fy":[-21.13879,-0.77501,-1.31273,-20.8575]}, - {"t":2.95183, "x":6.56175, "y":4.58196, "heading":3.12692, "vx":-0.97895, "vy":-0.20254, "omega":0.20928, "ax":-0.48165, "ay":3.22936, "alpha":3.75037, "fx":[4.28676,3.51196,-18.52149,-19.86312], "fy":[43.40694,59.07955,59.03604,43.55117]}, - {"t":2.98302, "x":6.53098, "y":4.57722, "heading":3.13344, "vx":-0.99398, "vy":-0.10182, "omega":0.32626, "ax":0.52534, "ay":3.70831, "alpha":4.03531, "fx":[22.31087,19.98919,-4.20127,-4.73821], "fy":[50.27816,66.18602,67.43241,51.59188]}, - {"t":3.01421, "x":6.50024, "y":4.57585, "heading":-3.13957, "vx":-0.97759, "vy":0.01384, "omega":0.45212, "ax":0.41816, "ay":3.72498, "alpha":4.62833, "fx":[22.87558,19.9585,-7.69077,-8.58872], "fy":[49.59418,67.66094,68.62693,50.66507]}, - {"t":3.0454, "x":6.46995, "y":4.57809, "heading":-3.12547, "vx":-0.96455, "vy":0.13002, "omega":0.59647, "ax":0.4016, "ay":3.72457, "alpha":3.04692, "fx":[16.91669,15.25885,-3.31594,-3.35685], "fy":[52.9853,64.86788,65.28895,53.37898]}, - {"t":3.06572, "x":6.45044, "y":4.5815, "heading":-3.11335, "vx":-0.95639, "vy":0.2057, "omega":0.65838, "ax":0.40211, "ay":3.72635, "alpha":2.7808, "fx":[16.06592,14.4298,-2.60123,-2.35922], "fy":[53.62432,64.47105,64.697,53.84204]}, - {"t":3.08604, "x":6.43109, "y":4.58645, "heading":-3.09997, "vx":-0.94822, "vy":0.28142, "omega":0.71488, "ax":0.40245, "ay":3.72622, "alpha":2.57216, "fx":[15.39405,13.75478,-2.0298,-1.56237], "fy":[54.11069,64.15386,64.21693,54.14419]}, - {"t":3.10636, "x":6.4119, "y":4.59294, "heading":-3.08544, "vx":-0.94004, "vy":0.35713, "omega":0.76715, "ax":0.40282, "ay":3.72606, "alpha":2.38546, "fx":[14.80494,13.15041,-1.52213,-0.85292], "fy":[54.54129,63.86082,63.78085,54.43306]}, - {"t":3.12668, "x":6.39289, "y":4.60096, "heading":-3.06986, "vx":-0.93186, "vy":0.43283, "omega":0.81561, "ax":0.40323, "ay":3.7259, "alpha":2.22139, "fx":[14.29181,12.60953,-1.07243,-0.22239], "fy":[54.93463,63.60739,63.39508,54.66819]}, - {"t":3.14699, "x":6.37403, "y":4.61053, "heading":-3.05328, "vx":-0.92366, "vy":0.50854, "omega":0.86075, "ax":0.40369, "ay":3.72571, "alpha":2.07816, "fx":[13.85054,12.12703,-0.67831,0.33645], "fy":[55.29847,63.40021,63.04157,54.85306]}, - {"t":3.16731, "x":6.35535, "y":4.62163, "heading":-3.0358, "vx":-0.91546, "vy":0.58424, "omega":0.90297, "ax":0.40421, "ay":3.72549, "alpha":1.95222, "fx":[13.47331,11.71037,-0.34024,0.82498], "fy":[55.61867,63.18308,62.74477,55.03332]}, - {"t":3.18763, "x":6.33683, "y":4.63427, "heading":-3.01745, "vx":-0.90725, "vy":0.65993, "omega":0.94264, "ax":0.40479, "ay":3.72525, "alpha":1.84873, "fx":[13.16921,11.34122,-0.05674,1.2516], "fy":[55.88199,63.04501,62.47527,55.16234]}, - {"t":3.20795, "x":6.31848, "y":4.64844, "heading":-2.9983, "vx":-0.89902, "vy":0.73563, "omega":0.9802, "ax":0.40545, "ay":3.72498, "alpha":1.76253, "fx":[12.92829,11.02401,0.17399,1.62088], "fy":[56.1135,62.92926,62.24237,55.26208]}, - {"t":3.22827, "x":6.3003, "y":4.66416, "heading":-2.97838, "vx":-0.89079, "vy":0.81131, "omega":1.01601, "ax":0.4062, "ay":3.72467, "alpha":1.69519, "fx":[12.75198,10.75405,0.35149,1.93758], "fy":[56.30567,62.86161,62.03859,55.3213]}, - {"t":3.24859, "x":6.28228, "y":4.68141, "heading":-2.95774, "vx":-0.88253, "vy":0.88699, "omega":1.05046, "ax":0.40708, "ay":3.7243, "alpha":1.64245, "fx":[12.63253,10.54079,0.47374,2.20342], "fy":[56.47845,62.76803,61.90034,55.35701]}, - {"t":3.26891, "x":6.26444, "y":4.70021, "heading":-2.93639, "vx":-0.87426, "vy":0.96266, "omega":1.08383, "ax":0.4081, "ay":3.72386, "alpha":1.61756, "fx":[12.59269,10.34665,0.54498,2.43091], "fy":[56.57288,62.883,61.71751,55.30294]}, - {"t":3.28922, "x":6.24676, "y":4.72053, "heading":-2.91437, "vx":-0.86597, "vy":1.03833, "omega":1.1167, "ax":0.4093, "ay":3.72335, "alpha":1.60738, "fx":[12.61559,10.2022,0.55813,2.61599], "fy":[56.6555,62.98901,61.57735,55.22154]}, - {"t":3.30954, "x":6.22925, "y":4.7424, "heading":-2.89168, "vx":-0.85765, "vy":1.11398, "omega":1.14936, "ax":0.41076, "ay":3.72272, "alpha":1.59917, "fx":[12.69592,10.11939,0.50909,2.75979], "fy":[56.78626,62.92633,61.51891,55.17183]}, - {"t":3.32986, "x":6.21191, "y":4.7658, "heading":-2.86833, "vx":-0.84931, "vy":1.18962, "omega":1.18185, "ax":0.41254, "ay":3.72193, "alpha":1.61207, "fx":[12.85189,10.07346,0.39995,2.87232], "fy":[56.87932,62.95227,61.46374,55.05805]}, - {"t":3.35018, "x":6.19473, "y":4.79074, "heading":-2.84431, "vx":-0.84093, "vy":1.26524, "omega":1.2146, "ax":0.4148, "ay":3.72092, "alpha":1.64854, "fx":[13.09413,10.06026,0.22764,2.9587], "fy":[56.93364,63.08288,61.40808,54.86485]}, - {"t":3.3705, "x":6.17773, "y":4.81722, "heading":-2.81964, "vx":-0.8325, "vy":1.34084, "omega":1.2481, "ax":0.41773, "ay":3.71959, "alpha":1.69368, "fx":[13.42255,10.09384,-0.01087,3.02137], "fy":[57.01837,63.11825,61.41045,54.65756]}, - {"t":3.39082, "x":6.16091, "y":4.84523, "heading":-2.79428, "vx":-0.82401, "vy":1.41642, "omega":1.28251, "ax":0.42171, "ay":3.71773, "alpha":1.78116, "fx":[13.86587,10.15166,-0.31247,3.0746], "fy":[57.00016,63.46896,61.33832,54.27922]}, - {"t":3.41113, "x":6.14425, "y":4.87478, "heading":-2.76822, "vx":-0.81544, "vy":1.49196, "omega":1.3187, "ax":0.42745, "ay":3.71496, "alpha":1.87555, "fx":[14.42786,10.27809,-0.68057,3.11911], "fy":[57.04279,63.6548,61.33418,53.87937]}, - {"t":3.43145, "x":6.12777, "y":4.90586, "heading":-2.74142, "vx":-0.80676, "vy":1.56744, "omega":1.35681, "ax":0.4366, "ay":3.7104, "alpha":2.02048, "fx":[15.16172,10.484,-1.09889,3.17826], "fy":[56.97894,64.16412,61.2263,53.25211]}, - {"t":3.45177, "x":6.11147, "y":4.93847, "heading":-2.71386, "vx":-0.79789, "vy":1.64283, "omega":1.39786, "ax":0.45381, "ay":3.7014, "alpha":2.17629, "fx":[16.16174,10.88566,-1.52152,3.29217], "fy":[57.0261,64.34455,61.19937,52.47968]}, - {"t":3.47209, "x":6.09535, "y":4.97261, "heading":-2.68545, "vx":-0.78866, "vy":1.71804, "omega":1.44208, "ax":0.50089, "ay":3.67502, "alpha":2.45264, "fx":[17.85177,11.86005,-1.65457,3.75047], "fy":[56.71359,65.00103,60.86443,50.79538]}, - {"t":3.49241, "x":6.07943, "y":5.00828, "heading":-2.65615, "vx":-0.77849, "vy":1.79271, "omega":1.49192, "ax":0.87025, "ay":2.74652, "alpha":2.94816, "fx":[24.92921,17.93514,2.9979,9.40108], "fy":[41.73979,52.68859,46.52465,33.45882]}, - {"t":3.51273, "x":6.06379, "y":5.04527, "heading":-2.62584, "vx":-0.76081, "vy":1.84851, "omega":1.55182, "ax":-3.33004, "ay":-1.4875, "alpha":3.07945, "fx":[-42.22479,-50.25317,-63.17766,-55.81199], "fy":[-27.09475,-11.73425,-20.83187,-34.79996]}, - {"t":3.53304, "x":6.04764, "y":5.08252, "heading":-2.59431, "vx":-0.82847, "vy":1.81829, "omega":1.61439, "ax":-3.28003, "ay":-1.5357, "alpha":3.70168, "fx":[-39.13825,-49.40232,-64.50533,-55.24572], "fy":[-28.21757,-9.91553,-21.51139,-37.87681]}, - {"t":3.55704, "x":6.02682, "y":5.12571, "heading":-2.55558, "vx":-0.90716, "vy":1.78144, "omega":1.7032, "ax":-3.21835, "ay":-1.72789, "alpha":3.0444, "fx":[-40.35452,-49.49515,-61.46027,-53.0648], "fy":[-30.41023,-15.40839,-25.33679,-38.57037]}, - {"t":3.58103, "x":6.00413, "y":5.16795, "heading":-2.51471, "vx":-0.98438, "vy":1.73999, "omega":1.77624, "ax":-3.08884, "ay":-1.83607, "alpha":2.60093, "fx":[-39.80627,-47.90906,-58.01037,-50.42498], "fy":[-31.20091,-18.83716,-27.87431,-38.68356]}, - {"t":3.60502, "x":5.97963, "y":5.20917, "heading":-2.4721, "vx":-1.05849, "vy":1.69594, "omega":1.83864, "ax":-2.91211, "ay":-1.90411, "alpha":2.17216, "fx":[-38.41334,-45.46515,-53.88898,-47.16035], "fy":[-31.47168,-21.71752,-29.57598,-38.15153]}, - {"t":3.62901, "x":5.95339, "y":5.24931, "heading":-2.42798, "vx":-1.12835, "vy":1.65025, "omega":1.89076, "ax":-1.99771, "ay":-2.61185, "alpha":1.74755, "fx":[-25.14993,-31.08227,-38.2373,-32.39097], "fy":[-42.03141,-34.87859,-41.46251,-47.48764]}, - {"t":3.65301, "x":5.92575, "y":5.28815, "heading":-2.38262, "vx":-1.17628, "vy":1.58759, "omega":1.93269, "ax":1.98352, "ay":-3.14025, "alpha":1.20829, "fx":[36.01631,32.42408,26.86489,30.65433], "fy":[-49.47351,-45.4162,-50.61794,-53.90726]}, - {"t":3.677, "x":5.89809, "y":5.32534, "heading":-2.33625, "vx":-1.12869, "vy":1.51225, "omega":1.96168, "ax":2.13089, "ay":-3.06409, "alpha":0.81623, "fx":[36.83371,34.42348,30.73831,33.32206], "fy":[-48.20714,-45.60203,-49.35451,-51.41521]}, - {"t":3.70099, "x":5.87163, "y":5.36074, "heading":-2.28918, "vx":-1.07757, "vy":1.43873, "omega":1.98126, "ax":2.18006, "ay":-3.03666, "alpha":0.45481, "fx":[36.26829,34.90903,32.87966,34.38321], "fy":[-47.87941,-46.52371,-48.67016,-49.76331]}, - {"t":3.72498, "x":5.8464, "y":5.39438, "heading":-2.24165, "vx":-1.02527, "vy":1.36587, "omega":1.99217, "ax":2.20461, "ay":-3.02256, "alpha":0.13234, "fx":[35.35961,35.12137,34.56322,34.95494], "fy":[-47.99558,-47.31034,-48.18261,-48.45312]}, - {"t":3.74898, "x":5.82244, "y":5.42628, "heading":-2.19385, "vx":-0.97237, "vy":1.29336, "omega":1.99535, "ax":2.21929, "ay":-3.01401, "alpha":-0.2165, "fx":[34.32025,35.24239,36.08733,35.28122], "fy":[-48.22033,-48.4695,-47.57198,-47.13695]}, - {"t":3.77297, "x":5.79975, "y":5.45645, "heading":-2.14598, "vx":-0.91913, "vy":1.22104, "omega":1.99015, "ax":2.22905, "ay":-3.00827, "alpha":-0.54953, "fx":[33.16875,35.4528,37.52844,35.40151], "fy":[-48.70463,-49.40629,-46.97927,-45.9439]}, - {"t":3.79696, "x":5.77834, "y":5.48488, "heading":-2.09823, "vx":-0.86565, "vy":1.14887, "omega":1.97697, "ax":2.23603, "ay":-3.00415, "alpha":-0.92242, "fx":[31.95758,35.67429,38.98491,35.37752], "fy":[-49.25704,-50.66634,-46.1936,-44.65511]}, - {"t":3.82095, "x":5.75821, "y":5.51157, "heading":-2.0508, "vx":-0.812, "vy":1.07679, "omega":1.95484, "ax":2.24124, "ay":-3.00105, "alpha":-1.30074, "fx":[30.65622,36.03051,40.45551,35.18293], "fy":[-50.03786,-51.78226,-45.34781,-43.4076]}, - {"t":3.84494, "x":5.73938, "y":5.53655, "heading":-2.0039, "vx":-0.75823, "vy":1.00479, "omega":1.92363, "ax":2.24529, "ay":-2.99864, "alpha":-1.7121, "fx":[29.27159,36.51029,41.97797,34.82252], "fy":[-50.97807,-52.99715,-44.34387,-42.10312]}, - {"t":3.86894, "x":5.72183, "y":5.55979, "heading":-1.95775, "vx":-0.70436, "vy":0.93285, "omega":1.88255, "ax":2.24851, "ay":-2.99671, "alpha":-2.13698, "fx":[27.78213,37.1914,43.54798,34.26566], "fy":[-52.18837,-54.00815,-43.26343,-40.83995]}, - {"t":3.89293, "x":5.70558, "y":5.58131, "heading":-1.91258, "vx":-0.65041, "vy":0.86095, "omega":1.83128, "ax":2.25115, "ay":-2.99513, "alpha":-2.61185, "fx":[26.22089,37.98473,45.22258,33.52653], "fy":[-53.56122,-55.19345,-41.96596,-39.47896]}, - {"t":3.91692, "x":5.69062, "y":5.6011, "heading":-1.86864, "vx":-0.5964, "vy":0.78909, "omega":1.76862, "ax":2.25335, "ay":-2.99381, "alpha":-3.12623, "fx":[24.56813,38.97353,46.98774,32.5651], "fy":[-55.17306,-56.35593,-40.4993,-38.08746]}, - {"t":3.94091, "x":5.67696, "y":5.61917, "heading":-1.82621, "vx":-0.54234, "vy":0.71726, "omega":1.69361, "ax":2.25522, "ay":-2.99269, "alpha":-3.69871, "fx":[22.85977,40.07798,48.88317,31.39207], "fy":[-56.97532,-57.69854,-38.78573,-36.58494]}, - {"t":3.96491, "x":5.6646, "y":5.63552, "heading":-1.78558, "vx":-0.48823, "vy":0.64546, "omega":1.60487, "ax":2.2568, "ay":-2.99174, "alpha":-4.31577, "fx":[21.08691,41.38313,50.88598,29.95769], "fy":[-58.99984,-59.03173,-36.8907,-35.06173]}, - {"t":3.9889, "x":5.65353, "y":5.65015, "heading":-1.74707, "vx":-0.43408, "vy":0.57368, "omega":1.50132, "ax":2.25818, "ay":-2.99091, "alpha":-4.98465, "fx":[19.25315,42.87391,53.01638,28.25776], "fy":[-61.29143,-60.35686,-34.78978,-33.49328]}, - {"t":4.01289, "x":5.64377, "y":5.66305, "heading":-1.71105, "vx":-0.3799, "vy":0.50192, "omega":1.38173, "ax":2.25938, "ay":-2.99019, "alpha":-5.70831, "fx":[17.38478,44.53779,55.27585,26.27863], "fy":[-63.7918,-61.74445,-32.47229,-31.87721]}, - {"t":4.03688, "x":5.6353, "y":5.67423, "heading":-1.6779, "vx":-0.3257, "vy":0.43018, "omega":1.24478, "ax":2.26045, "ay":-2.98954, "alpha":-6.48629, "fx":[15.50576,46.32203,57.68036,24.03687], "fy":[-66.48826,-63.21588,-29.94217,-30.19839]}, - {"t":4.06087, "x":5.62814, "y":5.68369, "heading":-1.64803, "vx":-0.27146, "vy":0.35845, "omega":1.08915, "ax":2.26139, "ay":-2.98897, "alpha":-7.30464, "fx":[13.61458,48.27565,60.20558,21.509], "fy":[-69.36382,-64.63031,-27.28833,-28.52622]}, - {"t":4.08487, "x":5.62228, "y":5.69143, "heading":-1.6219, "vx":-0.21721, "vy":0.28674, "omega":0.9139, "ax":2.26222, "ay":-2.98847, "alpha":-8.1665, "fx":[11.75197,50.28192,62.87822,18.74557], "fy":[-72.33593,-66.1567,-24.48607,-26.79816]}, - {"t":4.10886, "x":5.61772, "y":5.69745, "heading":-1.59998, "vx":-0.16293, "vy":0.21504, "omega":0.71797, "ax":2.26298, "ay":-2.98801, "alpha":-9.05614, "fx":[9.91313,52.37029,65.67802,15.74472], "fy":[-75.38622,-67.65619,-21.63834,-25.06679]}, - {"t":4.13285, "x":5.61446, "y":5.70175, "heading":-1.58275, "vx":-0.10864, "vy":0.14335, "omega":0.50069, "ax":2.26367, "ay":-2.9876, "alpha":-9.97458, "fx":[8.07327,54.41749,68.62224,12.63646], "fy":[-78.4782,-69.26285,-18.77221,-23.20817]}, - {"t":4.15684, "x":5.61251, "y":5.70433, "heading":-1.57074, "vx":-0.05433, "vy":0.07167, "omega":0.26138, "ax":2.26428, "ay":-2.98723, "alpha":-10.89415, "fx":[6.16049,56.33774,71.65242,9.63764], "fy":[-81.52185,-70.93279,-16.00442,-21.23901]}, - {"t":4.18084, "x":5.61185, "y":5.70519, "heading":-1.56447, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":5.61185, "y":5.70519, "heading":-1.56572, "vx":0.52595, "vy":1.92494, "omega":2.95002, "ax":1.17916, "ay":-0.13416, "alpha":1.74809, "fx":[22.86517,14.47859,14.55218,22.98404], "fy":[2.58051,2.92095,-7.02678,-6.994]}, + {"t":0.01808, "x":5.62155, "y":5.73997, "heading":-1.51239, "vx":0.54727, "vy":1.92251, "omega":2.98162, "ax":3.40067, "ay":-1.02805, "alpha":1.33561, "fx":[56.86992,50.82813,51.11771,57.13685], "fy":[-12.73837,-12.09218,-20.48554,-19.96823]}, + {"t":0.03616, "x":5.632, "y":5.77455, "heading":-1.45849, "vx":0.60874, "vy":1.90393, "omega":3.00576, "ax":3.58426, "ay":-1.21496, "alpha":0.99479, "fx":[58.88043,54.59201,54.92988,59.20888], "fy":[-16.63096,-15.93041,-22.66225,-21.93011]}, + {"t":0.05423, "x":5.64359, "y":5.80877, "heading":-1.40415, "vx":0.67354, "vy":1.88196, "omega":3.02375, "ax":3.61745, "ay":-1.36744, "alpha":0.72467, "fx":[58.75597,55.76057,56.09077,59.11127], "fy":[-19.82368,-19.0905,-24.33997,-23.58261]}, + {"t":0.07231, "x":5.65636, "y":5.84257, "heading":-1.34949, "vx":0.73894, "vy":1.85724, "omega":3.03685, "ax":3.60561, "ay":-1.51013, "alpha":0.49961, "fx":[58.07783,56.10848,56.37529,58.40502], "fy":[-22.74568,-21.9972,-25.91085,-25.2438]}, + {"t":0.09039, "x":5.67031, "y":5.8759, "heading":-1.29459, "vx":0.80412, "vy":1.82994, "omega":3.04588, "ax":3.57184, "ay":-1.64744, "alpha":0.31002, "fx":[57.16584,56.03712,56.19844,57.42114], "fy":[-25.51132,-24.68877,-27.45352,-26.96358]}, + {"t":0.10847, "x":5.68543, "y":5.90871, "heading":-1.23953, "vx":0.86869, "vy":1.80016, "omega":3.05148, "ax":3.52465, "ay":-1.78093, "alpha":0.14639, "fx":[56.12248,55.70477,55.72857,56.27003], "fy":[-28.16725,-27.20504,-28.98147,-28.74071]}, + {"t":0.12654, "x":5.70171, "y":5.94096, "heading":-1.18436, "vx":0.93241, "vy":1.76796, "omega":3.05413, "ax":3.46787, "ay":-1.91119, "alpha":-0.00175, "fx":[54.98317,55.20012,55.05294,54.98344], "fy":[-30.74381,-29.58232,-30.48109,-30.55869]}, + {"t":0.14462, "x":5.71913, "y":5.97261, "heading":-1.12915, "vx":0.9951, "vy":1.73341, "omega":3.0541, "ax":3.40346, "ay":-2.0384, "alpha":-0.1404, "fx":[53.76304,54.58411,54.21723,53.56525], "fy":[-33.28523,-31.77045,-31.96065,-32.42823]}, + {"t":0.1627, "x":5.73768, "y":6.00361, "heading":-1.07394, "vx":1.05662, "vy":1.69656, "omega":3.05156, "ax":3.33257, "ay":-2.16262, "alpha":-0.28022, "fx":[52.47169,53.89934,53.25069,52.00646], "fy":[-35.79468,-33.83464,-33.38083,-34.32235]}, + {"t":0.18078, "x":5.75732, "y":6.03393, "heading":-1.01877, "vx":1.11687, "vy":1.65747, "omega":3.0465, "ax":3.25591, "ay":-2.2838, "alpha":-0.42903, "fx":[51.1205,53.17616,52.1682,50.29528], "fy":[-38.26564,-35.83882,-34.70519,-36.21842]}, + {"t":0.19886, "x":5.77805, "y":6.06352, "heading":-0.9637, "vx":1.17573, "vy":1.61618, "omega":3.03874, "ax":3.17397, "ay":-2.40187, "alpha":-0.59311, "fx":[49.71987,52.44885,50.97617,48.41121], "fy":[-40.71354,-37.77881,-35.91449,-38.11925]}, + {"t":0.21693, "x":5.79982, "y":6.09235, "heading":-0.90877, "vx":1.23311, "vy":1.57276, "omega":3.02802, "ax":3.08707, "ay":-2.51674, "alpha":-0.77686, "fx":[48.28279,51.75395,49.67013,46.33117], "fy":[-43.17335,-39.5663,-37.02166,-40.05913]}, + {"t":0.23501, "x":5.82261, "y":6.12037, "heading":-0.85403, "vx":1.28891, "vy":1.52727, "omega":3.01397, "ax":2.99548, "ay":-2.62831, "alpha":-0.9678, "fx":[46.90877,51.10336,48.21107,43.9985], "fy":[-45.47387,-41.16596,-38.11651,-42.14912]}, + {"t":0.25309, "x":5.8464, "y":6.14755, "heading":-0.79954, "vx":1.34307, "vy":1.47975, "omega":2.99648, "ax":2.89933, "ay":-2.73654, "alpha":-1.21212, "fx":[45.4668,50.56637,46.63663,41.44637], "fy":[-47.9727,-42.6083,-38.99112,-44.20627]}, + {"t":0.27117, "x":5.87116, "y":6.17385, "heading":-0.74537, "vx":1.39548, "vy":1.43028, "omega":2.97457, "ax":2.79849, "ay":-2.84162, "alpha":-1.48803, "fx":[44.08118,50.16427,44.85348,38.61329], "fy":[-50.42435,-43.8759,-39.82729,-46.32334]}, + {"t":0.28924, "x":5.89684, "y":6.19924, "heading":-0.6916, "vx":1.44607, "vy":1.37891, "omega":2.94767, "ax":2.69152, "ay":-2.94477, "alpha":-1.81171, "fx":[42.69984,49.84401,42.85405,35.5217], "fy":[-52.99598,-45.12072,-40.50875,-48.37633]}, + {"t":0.30732, "x":5.92342, "y":6.22369, "heading":-0.63831, "vx":1.49473, "vy":1.32568, "omega":2.91491, "ax":2.57274, "ay":-3.05044, "alpha":-2.19566, "fx":[41.33558,49.5984,40.50988,31.93296], "fy":[-55.59426,-46.34485,-41.03246,-50.74029]}, + {"t":0.3254, "x":5.95087, "y":6.24715, "heading":-0.58561, "vx":1.54124, "vy":1.27053, "omega":2.87522, "ax":2.42806, "ay":-3.16792, "alpha":-2.64632, "fx":[39.77662,49.25585,37.50208,27.65468], "fy":[-58.52664,-47.33568,-41.75898,-53.55113]}, + {"t":0.34348, "x":5.97912, "y":6.26961, "heading":-0.53364, "vx":1.58513, "vy":1.21326, "omega":2.82738, "ax":2.24599, "ay":-3.30044, "alpha":-3.17366, "fx":[37.88588,48.5919,33.6356,22.51336], "fy":[-61.73746,-48.65068,-42.44087,-56.75863]}, + {"t":0.36156, "x":6.00815, "y":6.291, "heading":-0.48252, "vx":1.62573, "vy":1.1536, "omega":2.77001, "ax":2.04141, "ay":-3.43153, "alpha":-3.76925, "fx":[35.95709,47.92191,28.96966,16.78659], "fy":[-64.96536,-49.71924,-43.1505,-60.07729]}, + {"t":0.37963, "x":6.03787, "y":6.31129, "heading":-0.43245, "vx":1.66264, "vy":1.09156, "omega":2.70187, "ax":1.83823, "ay":-3.5452, "alpha":-4.4464, "fx":[34.36815,47.6097,23.85874,10.89626], "fy":[-68.00732,-50.27602,-43.52712,-63.32005]}, + {"t":0.39771, "x":6.06823, "y":6.33045, "heading":-0.38361, "vx":1.69587, "vy":1.02747, "omega":2.62149, "ax":1.64929, "ay":-3.63752, "alpha":-5.1997, "fx":[33.36107,47.79059,18.45835,5.1247], "fy":[-70.76033,-50.38886,-43.45856,-66.38544]}, + {"t":0.41579, "x":6.09915, "y":6.34843, "heading":-0.33621, "vx":1.72568, "vy":0.96172, "omega":2.52749, "ax":1.47869, "ay":-3.71064, "alpha":-6.03217, "fx":[32.97354,48.52459,12.78894,-0.38612], "fy":[-73.31061,-49.894,-43.06459,-69.36764]}, + {"t":0.43387, "x":6.13059, "y":6.36521, "heading":-0.29052, "vx":1.75241, "vy":0.89464, "omega":2.41844, "ax":1.32652, "ay":-3.76816, "alpha":-6.93334, "fx":[33.16582,49.8267,6.80648,-5.56132], "fy":[-75.63634,-48.97924,-42.42886,-72.24454]}, + {"t":0.45194, "x":6.16249, "y":6.38076, "heading":-0.2468, "vx":1.77639, "vy":0.82652, "omega":2.2931, "ax":1.19136, "ay":-3.81342, "alpha":-7.89338, "fx":[33.90022,51.58916,0.49651,-10.33119], "fy":[-77.78302,-47.69556,-41.61919,-75.06565]}, + {"t":0.47002, "x":6.1948, "y":6.39508, "heading":-0.20535, "vx":1.79793, "vy":0.75758, "omega":2.15041, "ax":1.07132, "ay":-3.8492, "alpha":-8.90255, "fx":[35.09263,53.73245,-6.14106,-14.65186], "fy":[-79.79451,-46.02682,-40.7493,-77.86465]}, + {"t":0.4881, "x":6.22747, "y":6.40815, "heading":-0.16647, "vx":1.8173, "vy":0.68799, "omega":1.98947, "ax":0.96452, "ay":-3.87763, "alpha":-9.94064, "fx":[36.65787,56.17337,-13.07857,-18.50311], "fy":[-81.63218,-44.20358,-39.82427,-80.58081]}, + {"t":0.50618, "x":6.26048, "y":6.41995, "heading":-0.13051, "vx":1.83473, "vy":0.61789, "omega":1.80977, "ax":0.8692, "ay":-3.90036, "alpha":-10.99902, "fx":[38.48139,58.8452,-20.24082,-21.88925], "fy":[-83.3512,-42.12798,-38.95277,-83.25231]}, + {"t":0.52425, "x":6.29379, "y":6.43048, "heading":-0.09779, "vx":1.85045, "vy":0.54738, "omega":1.61093, "ax":0.78383, "ay":-3.91864, "alpha":-12.0577, "fx":[40.46922,61.676,-27.52634,-24.84316], "fy":[-84.92928,-39.96357,-38.13553,-85.8165]}, + {"t":0.54233, "x":6.32737, "y":6.43974, "heading":-0.06867, "vx":1.86462, "vy":0.47654, "omega":1.39295, "ax":0.70711, "ay":-3.93341, "alpha":-13.10756, "fx":[42.4623,64.64716,-34.77917,-27.42644], "fy":[-86.4391,-37.52185,-37.53346,-88.28863]}, + {"t":0.56041, "x":6.3612, "y":6.44771, "heading":-0.04349, "vx":1.8774, "vy":0.40544, "omega":1.156, "ax":0.63791, "ay":-3.94541, "alpha":-14.12833, "fx":[44.44972,67.61528,-41.85996,-29.69577], "fy":[-87.85125,-35.22087,-36.85828,-90.61462]}, + {"t":0.57849, "x":6.39524, "y":6.4544, "heading":-0.02259, "vx":1.88893, "vy":0.33411, "omega":0.90059, "ax":0.57528, "ay":-3.95519, "alpha":-15.10838, "fx":[46.32191,70.57684,-48.62185,-31.7452], "fy":[-89.20581,-33.02543,-36.16892,-92.76629]}, + {"t":0.59657, "x":6.42948, "y":6.45979, "heading":-0.00631, "vx":1.89933, "vy":0.26261, "omega":0.62746, "ax":0.51667, "ay":-3.96054, "alpha":-15.06387, "fx":[45.83161,68.94235,-50.21591,-31.74771], "fy":[-89.01639,-32.77914,-36.81056,-92.90006]}, + {"t":0.61614, "x":6.46675, "y":6.46417, "heading":0.00597, "vx":1.90944, "vy":0.1851, "omega":0.33265, "ax":0.44802, "ay":-3.9717, "alpha":-14.16205, "fx":[43.43763,63.43984,-47.7052,-30.72183], "fy":[-87.52069,-34.36835,-39.16844,-91.1569]}, + {"t":0.63571, "x":6.50421, "y":6.46703, "heading":0.01248, "vx":1.91821, "vy":0.10737, "omega":0.05549, "ax":0.37074, "ay":-3.97947, "alpha":-13.29522, "fx":[40.7314,58.00834,-45.33688,-29.85956], "fy":[-86.27445,-36.29901,-40.70253,-89.43198]}, + {"t":0.65528, "x":6.54182, "y":6.46837, "heading":0.01357, "vx":1.92547, "vy":0.02949, "omega":-0.20471, "ax":0.28386, "ay":-3.9864, "alpha":-12.40863, "fx":[37.64721,52.49488,-42.9205,-29.19543], "fy":[-85.11674,-38.47578,-41.98835,-87.56743]}, + {"t":0.67485, "x":6.57956, "y":6.46819, "heading":0.00956, "vx":1.93102, "vy":-0.04853, "omega":-0.44755, "ax":0.18571, "ay":-3.99195, "alpha":-11.5163, "fx":[34.16182,46.94435,-40.56944,-28.74342], "fy":[-84.05243,-40.68683,-43.15912,-85.60215]}, + {"t":0.69442, "x":6.61738, "y":6.46647, "heading":0.0008, "vx":1.93466, "vy":-0.12665, "omega":-0.67293, "ax":0.07427, "ay":-3.99532, "alpha":-10.62198, "fx":[30.3228,41.32125,-38.4,-28.52737], "fy":[-83.00998,-43.01117,-44.16787,-83.52543]}, + {"t":0.71399, "x":6.65526, "y":6.46323, "heading":-0.01237, "vx":1.93611, "vy":-0.20484, "omega":-0.88081, "ax":-0.05286, "ay":-3.99537, "alpha":-9.73872, "fx":[26.15094,35.60453,-36.54071,-28.57152], "fy":[-81.96555,-45.39474,-44.98935,-81.36785]}, + {"t":0.73356, "x":6.69314, "y":6.45845, "heading":-0.02961, "vx":1.93508, "vy":-0.28303, "omega":-1.07141, "ax":-0.19851, "ay":-3.99045, "alpha":-8.87428, "fx":[21.56875,29.80213,-35.068,-28.90869], "fy":[-80.90016,-47.54715,-45.80926,-79.14866]}, + {"t":0.75313, "x":6.73097, "y":6.45215, "heading":-0.05058, "vx":1.93119, "vy":-0.36113, "omega":-1.24508, "ax":-0.36581, "ay":-3.97822, "alpha":-8.03996, "fx":[16.62248,23.84163,-34.10456,-29.58941], "fy":[-79.76315,-49.48278,-46.50407,-76.87868]}, + {"t":0.7727, "x":6.7687, "y":6.44432, "heading":-0.07494, "vx":1.92403, "vy":-0.43899, "omega":-1.40243, "ax":-0.55783, "ay":-3.95543, "alpha":-7.23497, "fx":[11.29041,17.66888,-33.72126,-30.66212], "fy":[-78.45934,-51.17916,-47.03277,-74.50996]}, + {"t":0.79227, "x":6.80625, "y":6.43497, "heading":-0.10239, "vx":1.91312, "vy":-0.5164, "omega":-1.54402, "ax":-0.77644, "ay":-3.91788, "alpha":-6.47137, "fx":[5.59127,11.25059,-33.97999,-32.1681], "fy":[-76.9449,-52.46641,-47.34314,-72.04216]}, + {"t":0.81184, "x":6.84354, "y":6.42412, "heading":-0.13261, "vx":1.89792, "vy":-0.59307, "omega":-1.67067, "ax":-1.01907, "ay":-3.86129, "alpha":-5.74406, "fx":[-0.41247,4.63861,-34.85508,-34.08518], "fy":[-75.07728,-53.43617,-47.31441,-69.3754]}, + {"t":0.83141, "x":6.88049, "y":6.41177, "heading":-0.1653, "vx":1.87798, "vy":-0.66864, "omega":-1.78309, "ax":-1.27111, "ay":-3.78513, "alpha":-5.06638, "fx":[-6.47786,-1.93838,-36.10863,-36.19432], "fy":[-72.91435,-53.77458,-47.06341,-66.6143]}, + {"t":0.85098, "x":6.917, "y":6.39796, "heading":-0.2002, "vx":1.8531, "vy":-0.74272, "omega":-1.88224, "ax":-1.4986, "ay":-3.70016, "alpha":-4.44014, "fx":[-12.0395,-7.91504,-37.22165,-37.98925], "fy":[-70.5978,-53.65096,-46.77487,-63.94757]}, + {"t":0.87056, "x":6.95298, "y":6.38272, "heading":-0.23704, "vx":1.82377, "vy":-0.81513, "omega":-1.96914, "ax":-1.679, "ay":-3.62093, "alpha":-3.85375, "fx":[-16.72649,-12.94239,-37.81426,-39.13809], "fy":[-68.2803,-53.50619,-46.6161,-61.53728]}, + {"t":0.89013, "x":6.98835, "y":6.36607, "heading":-0.27557, "vx":1.79091, "vy":-0.886, "omega":-2.04456, "ax":-1.82996, "ay":-3.5459, "alpha":-3.31463, "fx":[-20.78921,-17.29948,-38.19568,-39.92352], "fy":[-66.00074,-53.23262,-46.56815,-59.37375]}, + {"t":0.9097, "x":7.02305, "y":6.34805, "heading":-0.31559, "vx":1.7551, "vy":-0.95539, "omega":-2.10943, "ax":-1.96962, "ay":-3.4689, "alpha":-2.80716, "fx":[-24.53125,-21.32605,-38.61237,-40.60727], "fy":[-63.60666,-52.92081,-46.47199,-57.2859]}, + {"t":0.92927, "x":7.05702, "y":6.32869, "heading":-0.35687, "vx":1.71655, "vy":-1.02328, "omega":-2.16437, "ax":-2.10406, "ay":-3.38737, "alpha":-2.34703, "fx":[-28.02104,-25.12051,-39.17907,-41.29323], "fy":[-61.20636,-52.17737,-46.38233,-55.34162]}, + {"t":0.94884, "x":7.09021, "y":6.30801, "heading":-0.39923, "vx":1.67537, "vy":-1.08957, "omega":-2.2103, "ax":-2.23445, "ay":-3.30072, "alpha":-1.91267, "fx":[-31.30859,-28.73788,-39.87132,-41.9762], "fy":[-58.67009,-51.31995,-46.19719,-53.41815]}, + {"t":0.96841, "x":7.12257, "y":6.28606, "heading":-0.44249, "vx":1.63164, "vy":-1.15417, "omega":-2.24773, "ax":-2.36081, "ay":-3.20892, "alpha":-1.5088, "fx":[-34.37698,-32.17384,-40.70249,-42.66486], "fy":[-56.03824,-50.31604,-45.90299,-51.51856]}, + {"t":0.98798, "x":7.15405, "y":6.26286, "heading":-0.48648, "vx":1.58544, "vy":-1.21697, "omega":-2.27726, "ax":-2.4829, "ay":-3.11203, "alpha":-1.12622, "fx":[-37.24648,-35.48553,-41.62406,-43.31547], "fy":[-53.35277,-48.9678,-45.59607,-49.70624]}, + {"t":1.00755, "x":7.1846, "y":6.23844, "heading":-0.53104, "vx":1.53685, "vy":-1.27788, "omega":-2.2993, "ax":-2.60041, "ay":-3.01011, "alpha":-0.76211, "fx":[-39.90635,-38.65858,-42.63829,-43.93057], "fy":[-50.58478,-47.42531,-45.21315,-47.92776]}, + {"t":1.02712, "x":7.21418, "y":6.21286, "heading":-0.57604, "vx":1.48596, "vy":-1.33679, "omega":-2.31421, "ax":-2.71294, "ay":-2.90323, "alpha":-0.40443, "fx":[-42.37457,-41.71415,-43.71424,-44.4766], "fy":[-47.66447,-45.82028,-44.73794,-46.14072]}, + {"t":1.04669, "x":7.24274, "y":6.18614, "heading":-0.62133, "vx":1.43286, "vy":-1.39361, "omega":-2.32213, "ax":-2.81996, "ay":-2.79139, "alpha":-0.05232, "fx":[-44.63655,-44.6596,-44.84182,-44.93794], "fy":[-44.63769,-44.02301,-44.21434,-44.38616]}, + {"t":1.06626, "x":7.27025, "y":6.15833, "heading":-0.66678, "vx":1.37767, "vy":-1.44823, "omega":-2.32315, "ax":-2.92078, "ay":-2.67455, "alpha":0.30354, "fx":[-46.69196,-47.51099,-45.99667,-45.27857], "fy":[-41.47672,-42.03562,-43.66281,-42.66672]}, + {"t":1.08583, "x":7.29665, "y":6.12948, "heading":-0.71224, "vx":1.32051, "vy":-1.50058, "omega":-2.31721, "ax":-3.0144, "ay":-2.55258, "alpha":0.66807, "fx":[-48.5217,-50.2658,-47.16372,-45.47205], "fy":[-38.17748,-39.83148,-43.09618,-40.99124]}, + {"t":1.1054, "x":7.32191, "y":6.09962, "heading":-0.75759, "vx":1.26152, "vy":-1.55053, "omega":-2.30414, "ax":-3.09934, "ay":-2.42519, "alpha":1.04852, "fx":[-50.10378,-52.91465,-48.31961,-45.47915], "fy":[-34.6933,-37.45785,-42.50989,-39.34568]}, + {"t":1.12497, "x":7.34601, "y":6.06881, "heading":-0.80269, "vx":1.20086, "vy":-1.598, "omega":-2.28362, "ax":-3.17353, "ay":-2.29167, "alpha":1.45009, "fx":[-51.39759,-55.42736,-49.43954,-45.26395], "fy":[-30.99501,-34.88316,-41.91701,-37.7325]}, + {"t":1.14455, "x":7.3689, "y":6.0371, "heading":-0.84738, "vx":1.13875, "vy":-1.64285, "omega":-2.25524, "ax":-3.25601, "ay":-2.11749, "alpha":1.87763, "fx":[-52.6803,-58.07568,-50.85192,-45.15803], "fy":[-26.4902,-31.5449,-40.82269,-35.60882]}, + {"t":1.16412, "x":7.39057, "y":6.00454, "heading":-0.89152, "vx":1.07503, "vy":-1.68429, "omega":-2.21849, "ax":-3.15428, "ay":-1.96495, "alpha":1.04717, "fx":[-50.29085,-53.79336,-49.87198,-46.34973], "fy":[-27.47676,-29.77393,-35.1529,-32.3763]}, + {"t":1.18823, "x":7.41557, "y":5.96335, "heading":-0.94501, "vx":0.99897, "vy":-1.73167, "omega":-2.19324, "ax":-3.25324, "ay":-1.78161, "alpha":0.89129, "fx":[-51.68774,-54.71028,-51.62374,-48.56839], "fy":[-25.00886,-27.0367,-31.65638,-29.43537]}, + {"t":1.21234, "x":7.43872, "y":5.92108, "heading":-0.9979, "vx":0.92052, "vy":-1.77463, "omega":-2.17175, "ax":-2.75355, "ay":-1.36404, "alpha":0.80635, "fx":[-43.5136,-46.48625,-43.93015,-40.92866], "fy":[-18.63271,-20.67353,-24.62182,-22.69258]}, + {"t":1.23646, "x":7.46011, "y":5.87789, "heading":-1.05027, "vx":0.85412, "vy":-1.80752, "omega":-2.1523, "ax":-1.6198, "ay":-0.74434, "alpha":0.71472, "fx":[-25.33467,-28.21028,-26.10589,-23.21127], "fy":[-8.9568,-11.35765,-14.29381,-12.65934]}, + {"t":1.26057, "x":7.48024, "y":5.83409, "heading":-1.10217, "vx":0.81506, "vy":-1.82547, "omega":-2.13507, "ax":-0.83766, "ay":-0.36856, "alpha":0.62247, "fx":[-12.80643,-15.49486,-13.7957,-11.09676], "fy":[-3.21847,-5.72094,-7.9004,-6.56462]}, + {"t":1.28469, "x":7.49965, "y":5.78996, "heading":-1.15365, "vx":0.79486, "vy":-1.83436, "omega":-2.12006, "ax":-0.46998, "ay":-0.20195, "alpha":0.54026, "fx":[-6.90511,-9.36783,-8.02033,-5.55167], "fy":[-0.85504,-3.18308,-4.92468,-3.86131]}, + {"t":1.3088, "x":7.51868, "y":5.74567, "heading":-1.20478, "vx":0.78353, "vy":-1.83923, "omega":-2.10703, "ax":-0.46662, "ay":-0.19712, "alpha":0.47051, "fx":[-6.82352,-9.04416,-7.9952,-5.76907], "fy":[-1.08711,-3.05322,-4.60037,-3.77709]}, + {"t":1.33291, "x":7.53744, "y":5.70126, "heading":-1.25559, "vx":0.77228, "vy":-1.84398, "omega":-2.09569, "ax":-0.83886, "ay":-0.34599, "alpha":0.41819, "fx":[-12.7302,-14.70966,-13.90727,-11.92315], "fy":[-3.79672,-5.16051,-6.81622,-6.19806]}, + {"t":1.35703, "x":7.55582, "y":5.65669, "heading":-1.30612, "vx":0.75205, "vy":-1.85233, "omega":-2.0856, "ax":-1.69523, "ay":-0.66654, "alpha":0.38663, "fx":[-26.34976,-28.08221,-27.4792,-25.74091], "fy":[-9.22643,-9.81927,-11.85925,-11.42242]}, + {"t":1.38114, "x":7.57346, "y":5.61183, "heading":-1.35641, "vx":0.71117, "vy":-1.8684, "omega":-2.07628, "ax":-3.02196, "ay":-1.0834, "alpha":0.36718, "fx":[-47.46899,-48.9393,-48.48027,-47.01486], "fy":[-16.18571,-15.92177,-18.49788,-18.19348]}, + {"t":1.40526, "x":7.58973, "y":5.56646, "heading":-1.40648, "vx":0.6383, "vy":-1.89452, "omega":-2.06742, "ax":-3.55895, "ay":-1.1104, "alpha":0.32873, "fx":[-56.05101,-57.29269,-56.94143,-55.71841], "fy":[-16.82649,-16.27547,-18.79274,-18.61916]}, + {"t":1.42937, "x":7.60409, "y":5.52045, "heading":-1.45633, "vx":0.55248, "vy":-1.9213, "omega":-2.0595, "ax":-3.73526, "ay":-0.97998, "alpha":0.29528, "fx":[-58.87824,-59.96599,-59.71153,-58.64391], "fy":[-14.85609,-14.29674,-16.58188,-16.49685]}, + {"t":1.45348, "x":7.61632, "y":5.47384, "heading":-1.506, "vx":0.46241, "vy":-1.94493, "omega":-2.05238, "ax":-3.83187, "ay":-0.81517, "alpha":0.26749, "fx":[-60.42491,-61.40215,-61.23468,-60.27301], "fy":[-12.28468,-11.81966,-13.84046,-13.82113]}, + {"t":1.4776, "x":7.62636, "y":5.4267, "heading":-1.55549, "vx":0.37001, "vy":-1.96459, "omega":-2.04593, "ax":-3.89396, "ay":-0.6366, "alpha":0.23791, "fx":[-61.40214,-62.30985,-62.22324,-61.34289], "fy":[-9.58928,-9.07461,-10.94297,-10.81883]}, + {"t":1.50171, "x":7.63415, "y":5.37914, "heading":-1.60482, "vx":0.27611, "vy":-1.97994, "omega":-2.04019, "ax":-3.93957, "ay":-0.41692, "alpha":0.24682, "fx":[-62.10499,-62.95718,-62.97886,-62.13297], "fy":[-6.10724,-5.4663,-7.43278,-7.46909]}, + {"t":1.52583, "x":7.63966, "y":5.33128, "heading":-1.65402, "vx":0.18111, "vy":-1.98999, "omega":-2.03424, "ax":-3.81894, "ay":1.09693, "alpha":0.22629, "fx":[-60.09054,-60.95448,-61.16492,-60.30385], "fy":[18.05646,18.21848,16.68092,16.70224]}, + {"t":1.54994, "x":7.64292, "y":5.28361, "heading":-1.70307, "vx":0.08902, "vy":-1.96354, "omega":-2.02878, "ax":-3.1679, "ay":2.41471, "alpha":0.21935, "fx":[-49.60214,-50.62993,-50.95458,-49.9844], "fy":[39.06644,38.86428,37.68084,37.72929]}, + {"t":1.57405, "x":7.64415, "y":5.23696, "heading":-1.752, "vx":0.01263, "vy":-1.90531, "omega":-2.02349, "ax":-2.73428, "ay":2.90359, "alpha":0.2399, "fx":[-42.56797,-43.77062,-44.20695,-43.08934], "fy":[46.85143,46.64587,45.43224,45.45716]}, + {"t":1.59817, "x":7.64365, "y":5.19186, "heading":-1.80079, "vx":-0.0533, "vy":-1.8353, "omega":-2.01771, "ax":-2.47356, "ay":3.13228, "alpha":0.26888, "fx":[-38.25268,-39.65786,-40.23446,-38.93355], "fy":[50.54845,50.30171,49.04264,49.01598]}, + {"t":1.62228, "x":7.64165, "y":5.14852, "heading":-1.84945, "vx":-0.11295, "vy":-1.75976, "omega":-2.01122, "ax":-2.30517, "ay":3.26034, "alpha":0.32042, "fx":[-35.36638,-36.99374,-37.77392,-36.25076], "fy":[52.62789,52.5382,50.98981,50.8855]}, + {"t":1.64639, "x":7.63826, "y":5.10703, "heading":-1.89794, "vx":-0.16854, "vy":-1.68114, "omega":-2.0035, "ax":-2.18868, "ay":3.34106, "alpha":0.38985, "fx":[-33.25684,-35.13448,-36.19335,-34.40317], "fy":[53.95417,54.12533,52.14973,51.93813]}, + {"t":1.67051, "x":7.63356, "y":5.06746, "heading":-1.94626, "vx":-0.22132, "vy":-1.60058, "omega":-1.9941, "ax":-2.1037, "ay":3.39621, "alpha":0.45856, "fx":[-31.58161,-33.78695,-35.16003,-33.06264], "fy":[54.95099,55.1668,52.95392,52.59755]}, + {"t":1.69462, "x":7.62761, "y":5.02986, "heading":-1.99434, "vx":-0.27205, "vy":-1.51868, "omega":-1.98304, "ax":-2.0391, "ay":3.43612, "alpha":0.54639, "fx":[-30.17047,-32.73109,-34.51663,-32.07071], "fy":[55.69617,56.07176,53.49127,52.94466]}, + {"t":1.71874, "x":7.62045, "y":4.99423, "heading":-2.04216, "vx":-0.32122, "vy":-1.43582, "omega":-1.96986, "ax":-1.9884, "ay":3.46628, "alpha":0.65382, "fx":[-28.91547,-31.85419,-34.1658,-31.33395], "fy":[56.27745,56.91827,53.8578,53.06517]}, + {"t":1.74285, "x":7.61213, "y":4.96062, "heading":-2.08966, "vx":-0.36916, "vy":-1.35224, "omega":-1.9541, "ax":-1.94759, "ay":3.48982, "alpha":0.77841, "fx":[-27.73787,-31.11071,-34.04037,-30.78847], "fy":[56.75637,57.70885,54.12608,53.0228]}, + {"t":1.76696, "x":7.60266, "y":4.92902, "heading":-2.13678, "vx":-0.41613, "vy":-1.26808, "omega":-1.93533, "ax":-1.91403, "ay":3.50871, "alpha":0.92293, "fx":[-26.59735,-30.42816,-34.11338,-30.40785], "fy":[57.15154,58.4976,54.32345,52.84055]}, + {"t":1.79108, "x":7.59207, "y":4.89947, "heading":-2.18345, "vx":-0.46228, "vy":-1.18348, "omega":-1.91307, "ax":-1.88597, "ay":3.52417, "alpha":1.08022, "fx":[-25.43721,-29.83136,-34.33592,-30.16037], "fy":[57.51765,59.19839,54.51787,52.56139]}, + {"t":1.81519, "x":7.58038, "y":4.87195, "heading":-2.22958, "vx":-0.50776, "vy":-1.09849, "omega":-1.88702, "ax":-1.86216, "ay":3.53707, "alpha":1.2687, "fx":[-24.25676,-29.20228,-34.72686,-30.06701], "fy":[57.80479,60.01407,54.66852,52.12676]}, + {"t":1.83931, "x":7.56759, "y":4.84649, "heading":-2.27509, "vx":-0.55267, "vy":-1.0132, "omega":-1.85643, "ax":-1.84171, "ay":3.54798, "alpha":1.47995, "fx":[-23.02384,-28.55484,-35.26542,-30.10988], "fy":[58.04863,60.84302,54.82519,51.59024]}, + {"t":1.86342, "x":7.55373, "y":4.82309, "heading":-2.31985, "vx":-0.59708, "vy":-0.92765, "omega":-1.82074, "ax":-1.82395, "ay":3.55733, "alpha":1.72159, "fx":[-21.71801,-27.86415,-35.94504,-30.29909], "fy":[58.2365,61.7469,54.98966,50.92783]}, + {"t":1.88753, "x":7.5388, "y":4.80176, "heading":-2.36376, "vx":-0.64106, "vy":-0.84186, "omega":-1.77923, "ax":-1.80839, "ay":3.56543, "alpha":2.00858, "fx":[-20.33334,-27.05621,-36.78793,-30.66068], "fy":[58.33326,62.85185,55.13418,50.09598]}, + {"t":1.91165, "x":7.52282, "y":4.78249, "heading":-2.40666, "vx":-0.68467, "vy":-0.75589, "omega":-1.73079, "ax":-1.79465, "ay":3.57251, "alpha":2.31988, "fx":[-18.82614,-26.21948,-37.74426,-31.17539], "fy":[58.41001,63.92186,55.35893,49.17429]}, + {"t":1.93576, "x":7.50578, "y":4.7653, "heading":-2.4484, "vx":-0.72794, "vy":-0.66974, "omega":-1.67485, "ax":-1.78242, "ay":3.57876, "alpha":2.66946, "fx":[-17.19115,-25.29596,-38.83109,-31.87044], "fy":[58.42899,65.07574,55.63574,48.12125]}, + {"t":1.95988, "x":7.48771, "y":4.75019, "heading":-2.48878, "vx":-0.77092, "vy":-0.58344, "omega":-1.61048, "ax":-1.77146, "ay":3.58431, "alpha":3.06212, "fx":[-15.41471,-24.2623,-40.0507,-32.7655], "fy":[58.38228,66.33358,55.9714,46.92678]}, + {"t":1.98399, "x":7.46861, "y":4.73717, "heading":-2.52762, "vx":-0.81364, "vy":-0.49701, "omega":-1.53664, "ax":-1.7616, "ay":3.58927, "alpha":3.49908, "fx":[-13.48162,-23.11232,-41.39446,-33.87849], "fy":[58.27224,67.68123,56.38513,45.59044]}, + {"t":2.0081, "x":7.44847, "y":4.72622, "heading":-2.56467, "vx":-0.85612, "vy":-0.41046, "omega":-1.45226, "ax":-1.80665, "ay":3.56485, "alpha":3.26119, "fx":[-15.46673,-23.69522,-40.96261,-34.60271], "fy":[57.38341,66.69196,56.39289,45.91046]}, + {"t":2.03919, "x":7.42099, "y":4.71519, "heading":-2.60982, "vx":-0.91228, "vy":-0.29965, "omega":-1.35089, "ax":-2.14114, "ay":3.37289, "alpha":2.78613, "fx":[-23.11676,-29.23183,-44.10912,-39.51074], "fy":[53.89673,62.40972,53.64246,44.23941]}, + {"t":2.07027, "x":7.3916, "y":4.7075, "heading":-2.65181, "vx":-0.97883, "vy":-0.1948, "omega":-1.26429, "ax":-0.51865, "ay":3.14249, "alpha":2.66668, "fx":[2.39817,-3.96046,-18.36511,-13.00832], "fy":[48.89319,57.81988,51.39409,41.44993]}, + {"t":2.10136, "x":7.36092, "y":4.70297, "heading":-2.69111, "vx":-0.99496, "vy":-0.09712, "omega":-1.18139, "ax":0.07238, "ay":-0.66891, "alpha":2.92153, "fx":[11.54432,5.33536,-9.21944,-3.06385], "fy":[-13.43759,-0.66717,-7.84887,-20.52423]}, + {"t":2.13244, "x":7.33003, "y":4.69962, "heading":-2.72783, "vx":-0.99271, "vy":-0.11792, "omega":-1.09058, "ax":0.04767, "ay":-0.38183, "alpha":2.46529, "fx":[9.52815,4.65481,-8.0445,-3.11116], "fy":[-8.68612,1.94532,-3.26886,-14.23788]}, + {"t":2.16353, "x":7.29919, "y":4.69577, "heading":-2.76173, "vx":-0.99122, "vy":-0.12978, "omega":-1.01395, "ax":0.01856, "ay":-0.13935, "alpha":2.09769, "fx":[7.71817,3.86858,-7.15675,-3.25159], "fy":[-4.65061,4.37369,0.47126,-9.04361]}, + {"t":2.19461, "x":7.26839, "y":4.69167, "heading":-2.79325, "vx":-0.99065, "vy":-0.13412, "omega":-0.94874, "ax":0.00824, "ay":-0.06044, "alpha":1.80816, "fx":[6.45233,3.39051,-6.20882,-3.11067], "fy":[-3.25724,4.6271,1.55016,-6.758]}, + {"t":2.22569, "x":7.2376, "y":4.68747, "heading":-2.82274, "vx":-0.99039, "vy":-0.13599, "omega":-0.89254, "ax":0.00711, "ay":-0.05146, "alpha":1.57289, "fx":[5.52884,3.08199,-5.3137,-2.84568], "fy":[-2.98795,4.00841,1.49975,-5.78818]}, + {"t":2.25678, "x":7.20682, "y":4.68322, "heading":-2.85048, "vx":-0.99017, "vy":-0.13759, "omega":-0.84365, "ax":0.0079, "ay":-0.05647, "alpha":1.38053, "fx":[4.80404,2.83773,-4.55913,-2.58103], "fy":[-2.94621,3.31925,1.23736,-5.19671]}, + {"t":2.28786, "x":7.17604, "y":4.67892, "heading":-2.87671, "vx":-0.98992, "vy":-0.13935, "omega":-0.80073, "ax":0.00821, "ay":-0.05793, "alpha":1.22363, "fx":[4.21348,2.62289,-3.95611,-2.359], "fy":[-2.85456,2.79566,1.05516,-4.67488]}, + {"t":2.31895, "x":7.14528, "y":4.67456, "heading":-2.9016, "vx":-0.98967, "vy":-0.14115, "omega":-0.7627, "ax":0.00786, "ay":-0.05481, "alpha":1.09936, "fx":[3.73923,2.4399,-3.49138,-2.18831], "fy":[-2.70624,2.44201,0.97701,-4.19317]}, + {"t":2.35003, "x":7.11452, "y":4.67014, "heading":-2.92531, "vx":-0.98942, "vy":-0.14285, "omega":-0.72853, "ax":0.00726, "ay":-0.04998, "alpha":1.0039, "fx":[3.36933,2.29545,-3.14006,-2.06389], "fy":[-2.55234,2.20009,0.95937,-3.78129]}, + {"t":2.38112, "x":7.08377, "y":4.66568, "heading":-2.94795, "vx":-0.9892, "vy":-0.14441, "omega":-0.69732, "ax":0.0067, "ay":-0.04567, "alpha":0.93609, "fx":[3.09949,2.19845,-2.88752,-1.98493], "fy":[-2.43592,2.03265,0.97046,-3.46719]}, + {"t":2.4122, "x":7.05302, "y":4.66117, "heading":-2.96963, "vx":-0.98899, "vy":-0.14583, "omega":-0.66822, "ax":0.00632, "ay":-0.04269, "alpha":0.89363, "fx":[2.92009,2.15171,-2.71987,-1.95031], "fy":[-2.37408,1.91838,0.99819,-3.25366]}, + {"t":2.44328, "x":7.02228, "y":4.65662, "heading":-2.9904, "vx":-0.98879, "vy":-0.14715, "omega":-0.64044, "ax":0.00613, "ay":-0.04102, "alpha":0.87618, "fx":[2.82613,2.15927,-2.63193,-1.96405], "fy":[-2.37229,1.85627,1.04667,-3.13581]}, + {"t":2.47437, "x":6.99155, "y":4.65202, "heading":-3.01031, "vx":-0.9886, "vy":-0.14843, "omega":-0.61321, "ax":0.00608, "ay":-0.04033, "alpha":0.88296, "fx":[2.81128,2.22319,-2.61868,-2.02961], "fy":[-2.42933,1.84698,1.12419,-3.10285]}, + {"t":2.50545, "x":6.96082, "y":4.64739, "heading":-3.02937, "vx":-0.98841, "vy":-0.14968, "omega":-0.58576, "ax":0.00614, "ay":-0.04035, "alpha":0.91435, "fx":[2.8731,2.34773,-2.67878,-2.15237], "fy":[-2.54661,1.89333,1.23955,-3.14854]}, + {"t":2.53654, "x":6.9301, "y":4.64272, "heading":-3.04757, "vx":-0.98822, "vy":-0.15094, "omega":-0.55734, "ax":0.0063, "ay":-0.04105, "alpha":0.97124, "fx":[3.0115,2.53874,-2.81216,-2.33816], "fy":[-2.72959,1.99497,1.39913,-3.27162]}, + {"t":2.56762, "x":6.89939, "y":4.638, "heading":-3.0649, "vx":-0.98803, "vy":-0.15221, "omega":-0.52715, "ax":0.0066, "ay":-0.04266, "alpha":1.05473, "fx":[3.22796,2.80313,-3.01918,-2.59273], "fy":[-2.98746,2.14758,1.60614,-3.47511]}, + {"t":2.5987, "x":6.86868, "y":4.63325, "heading":-3.08129, "vx":-0.98782, "vy":-0.15354, "omega":-0.49437, "ax":0.0071, "ay":-0.04547, "alpha":1.16737, "fx":[3.52853,3.15153,-3.30426,-2.92488], "fy":[-3.33386,2.34874,1.8652,-3.76757]}, + {"t":2.62979, "x":6.83797, "y":4.62846, "heading":-3.09665, "vx":-0.9876, "vy":-0.15495, "omega":-0.45808, "ax":0.00782, "ay":-0.0496, "alpha":1.31118, "fx":[3.91761,3.59303,-3.67123,-3.34275], "fy":[-3.77719,2.59606,2.18394,-4.15231]}, + {"t":2.66087, "x":6.80728, "y":4.62362, "heading":-3.11089, "vx":-0.98736, "vy":-0.15649, "omega":-0.41732, "ax":0.00867, "ay":-0.0544, "alpha":1.49038, "fx":[4.40412,4.14043,-4.13233,-3.86162], "fy":[-4.31875,2.90451,2.58632,-4.62686]}, + {"t":2.69196, "x":6.77659, "y":4.61873, "heading":-3.12386, "vx":-0.98709, "vy":-0.15819, "omega":-0.37099, "ax":0.00936, "ay":-0.05808, "alpha":1.70809, "fx":[4.99143,4.80128,-4.7009,-4.49732], "fy":[-4.93739,3.30235,3.11363,-5.16671]}, + {"t":2.72304, "x":6.74591, "y":4.61378, "heading":-3.1354, "vx":-0.9868, "vy":-0.15999, "omega":-0.3179, "ax":0.00949, "ay":-0.05821, "alpha":1.97006, "fx":[5.68843,5.58809,-5.40021,-5.27352], "fy":[-5.60769,3.83556,3.82091,-5.74535]}, + {"t":2.75413, "x":6.71524, "y":4.60878, "heading":3.13791, "vx":-0.9865, "vy":-0.1618, "omega":-0.25666, "ax":0.0092, "ay":-0.05579, "alpha":2.28107, "fx":[6.50994,6.5194,-6.24336,-6.20175], "fy":[-6.35452,4.49642,4.70462,-6.38915]}, + {"t":2.78521, "x":6.68458, "y":4.60372, "heading":3.12993, "vx":-0.98622, "vy":-0.16353, "omega":-0.18576, "ax":0.01105, "ay":-0.06619, "alpha":2.64969, "fx":[7.51778,7.65886,-7.21419,-7.26095], "fy":[-7.44187,5.07517,5.53144,-7.36823]}, + {"t":2.81629, "x":6.65393, "y":4.59861, "heading":3.12416, "vx":-0.98587, "vy":-0.16559, "omega":-0.10339, "ax":0.02341, "ay":-0.13757, "alpha":3.08817, "fx":[8.87235,9.15976,-8.20692,-8.33834], "fy":[-9.6715,4.88726,5.54158,-9.49365]}, + {"t":2.84738, "x":6.6233, "y":4.59339, "heading":3.12094, "vx":-0.98515, "vy":-0.16987, "omega":-0.0074, "ax":0.06106, "ay":-0.343, "alpha":3.62059, "fx":[10.87045,11.27228,-9.02575,-9.23978], "fy":[-14.29492,2.94199,3.58917,-14.0177]}, + {"t":2.87846, "x":6.59271, "y":4.58795, "heading":3.12071, "vx":-0.98325, "vy":-0.18053, "omega":0.10514, "ax":0.09935, "ay":-0.51727, "alpha":4.25065, "fx":[13.22653,13.51753,-10.00997,-10.425], "fy":[-18.71552,1.94947,2.23454,-18.31666]}, + {"t":2.90955, "x":6.56219, "y":4.58209, "heading":3.12398, "vx":-0.98016, "vy":-0.19661, "omega":0.23727, "ax":-0.42336, "ay":2.74122, "alpha":4.01435, "fx":[5.72353,5.33207,-18.05802,-19.88201], "fy":[35.10283,52.07015,51.89149,35.01103]}, + {"t":2.94063, "x":6.53152, "y":4.5773, "heading":3.13136, "vx":-0.99332, "vy":-0.1114, "omega":0.36206, "ax":0.02952, "ay":3.99461, "alpha":3.99075, "fx":[14.46295,12.53553,-11.96037,-13.16328], "fy":[55.55991,70.46131,71.24302,56.40508]}, + {"t":2.97172, "x":6.50066, "y":4.57577, "heading":-3.14058, "vx":-0.9924, "vy":0.01277, "omega":0.4861, "ax":0.29204, "ay":3.98753, "alpha":4.5748, "fx":[21.03014,18.14661,-9.68858,-10.94265], "fy":[54.32936,71.39995,72.22713,55.26357]}, + {"t":3.0028, "x":6.46995, "y":4.57809, "heading":-3.12547, "vx":-0.98332, "vy":0.13672, "omega":0.62831, "ax":0.31423, "ay":3.98346, "alpha":3.05871, "fx":[15.81544,14.10143,-4.87342,-5.08883], "fy":[57.3507,68.82341,69.09493,57.69257]}, + {"t":3.02333, "x":6.44983, "y":4.58174, "heading":-3.11257, "vx":-0.97687, "vy":0.21851, "omega":0.69111, "ax":0.31695, "ay":3.98523, "alpha":2.79675, "fx":[14.99879,13.34364,-4.16344,-4.05169], "fy":[57.98704,68.3656,68.57105,58.14998]}, + {"t":3.04386, "x":6.42984, "y":4.58706, "heading":-3.09838, "vx":-0.97036, "vy":0.30033, "omega":0.74853, "ax":0.31978, "ay":3.98488, "alpha":2.59834, "fx":[14.39647,12.70862,-3.58536,-3.21274], "fy":[58.42723,68.08742,68.12434,58.41281]}, + {"t":3.06439, "x":6.40998, "y":4.59407, "heading":-3.08301, "vx":-0.9638, "vy":0.38214, "omega":0.80188, "ax":0.32293, "ay":3.9845, "alpha":2.42112, "fx":[13.87587,12.14662,-3.06282,-2.45261], "fy":[58.82806,67.83193,67.72112,58.64619]}, + {"t":3.08493, "x":6.39026, "y":4.60276, "heading":-3.06654, "vx":-0.95717, "vy":0.46395, "omega":0.85159, "ax":0.32646, "ay":3.98406, "alpha":2.26645, "fx":[13.43894,11.65042,-2.59204,-1.76621], "fy":[59.17438,67.62994,67.35204,58.8433]}, + {"t":3.10546, "x":6.37068, "y":4.61312, "heading":-3.04906, "vx":-0.95047, "vy":0.54575, "omega":0.89812, "ax":0.33044, "ay":3.98357, "alpha":2.1327, "fx":[13.0839,11.22047,-2.17228,-1.14836], "fy":[59.48092,67.45951,67.0246,59.00322]}, + {"t":3.12599, "x":6.35123, "y":4.62517, "heading":-3.03062, "vx":-0.94368, "vy":0.62754, "omega":0.94191, "ax":0.33496, "ay":3.983, "alpha":2.01097, "fx":[12.78317,10.87934,-1.79887,-0.59293], "fy":[59.79006,67.21972,66.7583,59.16416]}, + {"t":3.14652, "x":6.33193, "y":4.63889, "heading":-3.01128, "vx":-0.9368, "vy":0.70932, "omega":0.9832, "ax":0.34013, "ay":3.98234, "alpha":1.91603, "fx":[12.58397,10.58096,-1.47423,-0.09116], "fy":[60.01963,67.11055,66.50296,59.25742]}, + {"t":3.16705, "x":6.31277, "y":4.65429, "heading":-2.99109, "vx":-0.92982, "vy":0.79108, "omega":1.02254, "ax":0.34613, "ay":3.98158, "alpha":1.83697, "fx":[12.45837,10.35416,-1.19473,0.36216], "fy":[60.22724,66.99558,66.28865,59.3303]}, + {"t":3.18758, "x":6.29375, "y":4.67137, "heading":-2.9701, "vx":-0.92271, "vy":0.87283, "omega":1.06025, "ax":0.35314, "ay":3.98066, "alpha":1.78207, "fx":[12.42583,10.17457,-0.95465,0.77962], "fy":[60.36767,66.99845,66.07994,59.3378]}, + {"t":3.20812, "x":6.27488, "y":4.69013, "heading":-2.94833, "vx":-0.91546, "vy":0.95456, "omega":1.09684, "ax":0.36146, "ay":3.97957, "alpha":1.73747, "fx":[12.46528,10.08261,-0.75672,1.1625], "fy":[60.52192,66.92647,65.92478,59.34093]}, + {"t":3.22865, "x":6.25616, "y":4.71057, "heading":-2.92581, "vx":-0.90804, "vy":1.03627, "omega":1.13251, "ax":0.37149, "ay":3.97822, "alpha":1.71432, "fx":[12.60651,10.05116,-0.59367,1.52662], "fy":[60.62529,66.93112,65.78492,59.2871]}, + {"t":3.24918, "x":6.23759, "y":4.73268, "heading":-2.90256, "vx":-0.90042, "vy":1.11794, "omega":1.16771, "ax":0.38382, "ay":3.97652, "alpha":1.71981, "fx":[12.87089,10.07133,-0.45748,1.88895], "fy":[60.65158,67.1,65.63517,59.13402]}, + {"t":3.26971, "x":6.21919, "y":4.75648, "heading":-2.87858, "vx":-0.89254, "vy":1.19959, "omega":1.20302, "ax":0.39934, "ay":3.97433, "alpha":1.72963, "fx":[13.23627,10.21646,-0.34683,2.25366], "fy":[60.71642,67.1148,65.54765,59.00266]}, + {"t":3.29024, "x":6.20095, "y":4.78194, "heading":-2.85388, "vx":-0.88434, "vy":1.28119, "omega":1.23854, "ax":0.41949, "ay":3.97139, "alpha":1.76349, "fx":[13.77289,10.44194,-0.23733,2.66131], "fy":[60.73105,67.21346,65.4663,58.78398]}, + {"t":3.31077, "x":6.18288, "y":4.80909, "heading":-2.82845, "vx":-0.87572, "vy":1.36273, "omega":1.27474, "ax":0.44668, "ay":3.96725, "alpha":1.81774, "fx":[14.49366,10.82975,-0.10192,3.14409], "fy":[60.71215,67.34061,65.38386,58.49513]}, + {"t":3.33131, "x":6.16499, "y":4.8379, "heading":-2.80228, "vx":-0.86655, "vy":1.44418, "omega":1.31206, "ax":0.48543, "ay":3.961, "alpha":1.89085, "fx":[15.49995,11.42145,0.1222,3.78288], "fy":[60.66439,67.4305,65.31996,58.12036]}, + {"t":3.35184, "x":6.1473, "y":4.86839, "heading":-2.77534, "vx":-0.85659, "vy":1.52551, "omega":1.35089, "ax":0.54514, "ay":3.95059, "alpha":2.00237, "fx":[16.94232,12.37021,0.57184,4.73358], "fy":[60.50044,67.72418,65.09799,57.55171]}, + {"t":3.37237, "x":6.12983, "y":4.90054, "heading":-2.74761, "vx":-0.84539, "vy":1.60662, "omega":1.392, "ax":0.64903, "ay":3.93019, "alpha":2.13994, "fx":[19.23912,14.03705,1.58111,6.35801], "fy":[60.19571,67.7558,64.91392,56.71345]}, + {"t":3.3929, "x":6.11261, "y":4.93436, "heading":-2.71903, "vx":-0.83207, "vy":1.68731, "omega":1.43593, "ax":0.8743, "ay":3.87578, "alpha":2.36014, "fx":[23.68855,17.66785,4.29822,9.86571], "fy":[59.25491,67.58178,64.35656,54.93037]}, + {"t":3.41343, "x":6.09571, "y":4.96982, "heading":-2.68955, "vx":-0.81412, "vy":1.76689, "omega":1.48439, "ax":1.68772, "ay":3.55234, "alpha":2.75714, "fx":[37.8853,30.77586,15.87618,22.6379], "fy":[53.97405,63.75011,60.01241,47.84739]}, + {"t":3.43396, "x":6.07935, "y":5.00684, "heading":-2.65907, "vx":-0.77947, "vy":1.83982, "omega":1.541, "ax":1.66215, "ay":0.73209, "alpha":3.51487, "fx":[39.24946,31.08184,13.6755,21.54471], "fy":[8.85839,23.05418,15.14634,-0.56892]}, + {"t":3.45449, "x":6.0637, "y":5.04477, "heading":-2.62743, "vx":-0.74534, "vy":1.85485, "omega":1.61317, "ax":-3.55833, "ay":-1.56002, "alpha":3.2989, "fx":[-44.90237,-53.97331,-67.6643,-59.42415], "fy":[-28.90789,-12.14745,-21.46148,-36.54906]}, + {"t":3.47503, "x":6.04764, "y":5.08252, "heading":-2.59431, "vx":-0.8184, "vy":1.82282, "omega":1.6809, "ax":-3.49347, "ay":-1.61698, "alpha":3.81346, "fx":[-42.14459,-52.94607,-68.1816,-58.57318], "fy":[-29.8726,-10.65544,-22.5452,-39.60942]}, + {"t":3.4984, "x":6.02756, "y":5.12469, "heading":-2.55501, "vx":-0.90006, "vy":1.78502, "omega":1.77004, "ax":-3.42322, "ay":-1.82374, "alpha":3.12218, "fx":[-43.35408,-52.91668,-64.90035,-56.21369], "fy":[-32.20518,-16.51775,-26.66399,-40.42588]}, + {"t":3.52178, "x":6.00558, "y":5.16592, "heading":-2.51364, "vx":-0.98009, "vy":1.74239, "omega":1.84303, "ax":-3.25379, "ay":-1.92591, "alpha":2.69209, "fx":[-42.11882,-50.59427,-60.89541,-53.0165], "fy":[-32.7744,-19.84124,-29.20536,-40.4797]}, + {"t":3.54516, "x":5.98178, "y":5.20613, "heading":-2.47055, "vx":-1.05615, "vy":1.69737, "omega":1.90596, "ax":-2.90048, "ay":-1.88673, "alpha":2.2931, "fx":[-37.87434,-45.21145,-54.04513,-47.05824], "fy":[-31.21017,-20.86568,-29.35716,-38.38002]}, + {"t":3.56853, "x":5.9563, "y":5.24529, "heading":-2.426, "vx":-1.12395, "vy":1.65326, "omega":1.95957, "ax":-2.03876, "ay":-1.43043, "alpha":1.83435, "fx":[-25.63851,-31.78705,-39.01168,-33.03018], "fy":[-23.15763,-15.75778,-22.54183,-29.37906]}, + {"t":3.59191, "x":5.92947, "y":5.28355, "heading":-2.38019, "vx":-1.17161, "vy":1.61982, "omega":2.00245, "ax":-0.29557, "ay":-2.27272, "alpha":1.31421, "fx":[0.34238,-4.18173,-9.74119,-5.18912], "fy":[-35.97671,-31.35024,-36.42313,-40.57454]}, + {"t":3.61529, "x":5.902, "y":5.3208, "heading":-2.33338, "vx":-1.17852, "vy":1.5667, "omega":2.03317, "ax":2.33132, "ay":-3.20417, "alpha":0.75385, "fx":[39.83884,37.59434,34.09628,36.51639], "fy":[-50.39471,-48.1492,-51.5338,-53.39629]}, + {"t":3.63866, "x":5.87509, "y":5.35654, "heading":-2.28585, "vx":-1.12402, "vy":1.49179, "omega":2.05079, "ax":2.37358, "ay":-3.19649, "alpha":0.35456, "fx":[39.04323,37.92751,36.27348,37.48499], "fy":[-50.39707,-49.55537,-51.09004,-51.94417]}, + {"t":3.66204, "x":5.84946, "y":5.39054, "heading":-2.23791, "vx":-1.06854, "vy":1.41707, "omega":2.05908, "ax":2.38749, "ay":-3.19391, "alpha":-0.00641, "fx":[37.88318,37.93115,37.88416,37.91434], "fy":[-50.6966,-50.78283,-50.64347,-50.69982]}, + {"t":3.68542, "x":5.82513, "y":5.4228, "heading":-2.18977, "vx":-1.01273, "vy":1.34241, "omega":2.05893, "ax":2.39435, "ay":-3.19267, "alpha":-0.35244, "fx":[36.61715,37.93489,39.36896,38.12699], "fy":[-51.20681,-51.8439,-50.15326,-49.53964]}, + {"t":3.70879, "x":5.80211, "y":5.45331, "heading":-2.14164, "vx":-0.95675, "vy":1.26777, "omega":2.05069, "ax":2.39856, "ay":-3.19183, "alpha":-0.71075, "fx":[35.26993,38.05988,40.81785,38.16784], "fy":[-51.85023,-52.93601,-49.53781,-48.36657]}, + {"t":3.73217, "x":5.7804, "y":5.48207, "heading":-2.0937, "vx":-0.90068, "vy":1.19316, "omega":2.03408, "ax":2.4013, "ay":-3.19132, "alpha":-1.09825, "fx":[33.86644,38.24426,42.30629,38.07282], "fy":[-52.60244,-54.18087,-48.74991,-47.12474]}, + {"t":3.75555, "x":5.76, "y":5.50909, "heading":-2.04615, "vx":-0.84455, "vy":1.11855, "omega":2.0084, "ax":2.40334, "ay":-3.19089, "alpha":-1.48707, "fx":[32.36776,38.63046,43.81899,37.80188], "fy":[-53.59977,-55.18661,-47.90503,-45.93947]}, + {"t":3.77893, "x":5.74092, "y":5.53437, "heading":-1.9992, "vx":-0.78837, "vy":1.04396, "omega":1.97364, "ax":2.40482, "ay":-3.19061, "alpha":-1.92262, "fx":[30.8061,39.10725,45.41893,37.38057], "fy":[-54.7091,-56.42245,-46.83802,-44.64332]}, + {"t":3.8023, "x":5.72314, "y":5.5579, "heading":-1.95306, "vx":-0.73215, "vy":0.96937, "omega":1.9287, "ax":2.40592, "ay":-3.19042, "alpha":-2.38357, "fx":[29.16148,39.7458,47.10022,36.77539], "fy":[-56.04603,-57.57989,-45.63698,-43.33811]}, + {"t":3.82568, "x":5.70669, "y":5.57969, "heading":-1.90798, "vx":-0.67591, "vy":0.89479, "omega":1.87298, "ax":2.40686, "ay":-3.19023, "alpha":-2.8885, "fx":[27.4485,40.53139,48.88511,35.97741], "fy":[-57.5617,-58.83251,-44.23214,-41.96246]}, + {"t":3.84906, "x":5.69154, "y":5.59973, "heading":-1.86419, "vx":-0.61964, "vy":0.82021, "omega":1.80545, "ax":2.40759, "ay":-3.1901, "alpha":-3.43482, "fx":[25.6558,41.50578,50.77128,34.95601], "fy":[-59.3052,-60.08457,-42.64084,-40.54991]}, + {"t":3.87243, "x":5.67772, "y":5.61804, "heading":-1.82199, "vx":-0.56336, "vy":0.74564, "omega":1.72516, "ax":2.40824, "ay":-3.18995, "alpha":-4.02224, "fx":[23.78895,42.70166,52.75569,33.68421], "fy":[-61.28379,-61.29239,-40.86686,-39.12835]}, + {"t":3.89581, "x":5.6652, "y":5.6346, "heading":-1.78166, "vx":-0.50706, "vy":0.67107, "omega":1.63113, "ax":2.40874, "ay":-3.18987, "alpha":-4.66076, "fx":[21.8871,44.04447,54.86418,32.16642], "fy":[-63.4616,-62.58211,-38.87482,-37.64781]}, + {"t":3.91919, "x":5.65401, "y":5.64941, "heading":-1.74353, "vx":-0.45075, "vy":0.5965, "omega":1.52218, "ax":2.40919, "ay":-3.18979, "alpha":-5.34688, "fx":[19.96096,45.55595,57.09148,30.3821], "fy":[-65.84119,-63.89972,-36.68034,-36.13985]}, + {"t":3.94256, "x":5.64413, "y":5.66248, "heading":-1.70794, "vx":-0.39443, "vy":0.52193, "omega":1.39718, "ax":2.40959, "ay":-3.18971, "alpha":-6.07841, "fx":[18.03195,47.22138,59.4369,28.32577], "fy":[-68.40428,-65.23891,-34.29694,-34.6157]}, + {"t":3.96594, "x":5.63557, "y":5.67381, "heading":-1.67528, "vx":-0.33811, "vy":0.44737, "omega":1.25509, "ax":2.40992, "ay":-3.18965, "alpha":-6.85435, "fx":[16.13927,48.96502,61.90886,26.02364], "fy":[-71.11756,-66.65905,-31.72181,-33.05396]}, + {"t":3.98932, "x":5.62832, "y":5.6834, "heading":-1.64594, "vx":-0.28177, "vy":0.3728, "omega":1.09486, "ax":2.41021, "ay":-3.1896, "alpha":-7.66277, "fx":[14.26512,50.86478,64.4789,23.44662], "fy":[-73.95285,-68.03125,-29.03911,-31.52588]}, + {"t":4.01269, "x":5.62239, "y":5.69124, "heading":-1.62035, "vx":-0.22543, "vy":0.29824, "omega":0.91573, "ax":2.41047, "ay":-3.18955, "alpha":-8.49765, "fx":[12.44613,52.83521,67.15126,20.63963], "fy":[-76.86094,-69.39907,-26.27721,-30.00876]}, + {"t":4.03607, "x":5.61778, "y":5.69734, "heading":-1.59894, "vx":-0.16908, "vy":0.22368, "omega":0.71708, "ax":2.41072, "ay":-3.18951, "alpha":-9.35583, "fx":[10.67221,54.81756,69.92887,17.66886], "fy":[-79.79472,-70.82049,-23.47375,-28.45408]}, + {"t":4.05945, "x":5.61449, "y":5.7017, "heading":-1.58218, "vx":-0.11272, "vy":0.14912, "omega":0.49837, "ax":2.41091, "ay":-3.18948, "alpha":-10.22671, "fx":[8.94411,56.75661,72.80263,14.59666], "fy":[-82.7065,-72.2999,-20.6993,-26.83561]}, + {"t":4.08282, "x":5.61251, "y":5.70432, "heading":-1.57053, "vx":-0.05636, "vy":0.07456, "omega":0.2593, "ax":2.41108, "ay":-3.18946, "alpha":-11.09221, "fx":[7.25923,58.52129,75.73002,11.60014], "fy":[-85.58028,-73.83649,-18.04973,-25.07374]}, + {"t":4.1062, "x":5.61185, "y":5.70519, "heading":-1.56447, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[ {"name":"IntakeDown", "from":{"target":0, "targetTimestamp":0.0, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeDown"}}}, - {"name":"IntakeUp", "from":{"target":5, "targetTimestamp":3.53304, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] + {"name":"IntakeUp", "from":{"target":5, "targetTimestamp":3.47503, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] } diff --git a/src/main/deploy/choreo/LeftSecondDipShort.traj b/src/main/deploy/choreo/LeftSecondDipShort.traj new file mode 100644 index 00000000..4783f780 --- /dev/null +++ b/src/main/deploy/choreo/LeftSecondDipShort.traj @@ -0,0 +1,205 @@ +{ + "name":"LeftSecondDipShort", + "version":3, + "snapshot":{ + "waypoints":[ + {"x":5.611854076385498, "y":5.705188751220703, "heading":-1.5657181171509245, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":7.448474407196045, "y":4.726224899291992, "heading":-2.671099987796757, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.064094543457031, "y":4.601637363433838, "heading":-3.1254652057435086, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.831842422485352, "y":5.160763740539551, "heading":-2.594308272602356, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.611854076385498, "y":5.705188274383545, "heading":-1.564467367692855, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + "constraints":[ + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":true}, + {"from":0, "to":4, "data":{"type":"MaxAcceleration", "props":{"max":4.0}}, "enabled":true}, + {"from":0, "to":4, "data":{"type":"MaxAngularVelocity", "props":{"max":4.0}}, "enabled":true}, + {"from":1, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, + {"from":2, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"first", "to":1, "data":{"type":"MaxVelocity", "props":{"max":3.0}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"MaxVelocity", "props":{"max":1.0}}, "enabled":true}, + {"from":2, "to":4, "data":{"type":"MaxVelocity", "props":{"max":2.0}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"KeepInLane", "props":{"tolerance":0.01}}, "enabled":true}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"5.611854076385498 m", "val":5.611854076385498}, "y":{"exp":"5.705188751220703 m", "val":5.705188751220703}, "heading":{"exp":"-1.5657181171509245 rad", "val":-1.5657181171509245}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"7.448474407196045 m", "val":7.448474407196045}, "y":{"exp":"4.726224899291992 m", "val":4.726224899291992}, "heading":{"exp":"-2.671099987796757 rad", "val":-2.671099987796757}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.064094543457031 m", "val":6.064094543457031}, "y":{"exp":"4.601637363433838 m", "val":4.601637363433838}, "heading":{"exp":"-3.1254652057435086 rad", "val":-3.1254652057435086}, "intervals":22, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.831842422485352 m", "val":5.831842422485352}, "y":{"exp":"5.160763740539551 m", "val":5.160763740539551}, "heading":{"exp":"-2.594308272602356 rad", "val":-2.594308272602356}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.611854076385498 m", "val":5.611854076385498}, "y":{"exp":"5.705188274383545 m", "val":5.705188274383545}, "heading":{"exp":"-1.5644673676928553 rad", "val":-1.564467367692855}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + "constraints":[ + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":true}, + {"from":0, "to":4, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"4 m / s ^ 2", "val":4.0}}}, "enabled":true}, + {"from":0, "to":4, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"4 rad / s", "val":4.0}}}, "enabled":true}, + {"from":1, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, + {"from":2, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"first", "to":1, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"3 m / s", "val":3.0}}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"1 m / s", "val":1.0}}}, "enabled":true}, + {"from":2, "to":4, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"2 m / s", "val":2.0}}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"KeepInLane", "props":{"tolerance":{"exp":"0.01 m", "val":0.01}}}, "enabled":true}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "config":{ + "frontLeft":{ + "x":0.263525, + "y":0.301625 + }, + "backLeft":{ + "x":-0.263525, + "y":0.301625 + }, + "mass":63.502931800000006, + "inertia":5.903712368280681, + "gearing":5.27, + "radius":0.0508, + "vmax":555.0147021341968, + "tmax":1.3, + "cof":1.0, + "bumper":{ + "front":0.4460875, + "side":0.4079875, + "back":0.4460875 + }, + "differentialTrackWidth":0.5588 + }, + "sampleType":"Swerve", + "waypoints":[0.0,1.0688,2.58534,3.07637,3.6212], + "samples":[ + {"t":0.0, "x":5.61185, "y":5.70519, "heading":-1.56572, "vx":2.74477, "vy":-1.19999, "omega":-0.94649, "ax":0.07296, "ay":-0.13189, "alpha":-0.4929, "fx":[-0.02088,2.34224,2.33817,-0.02664], "fy":[-3.45235,-3.49376,-0.70573,-0.72333]}, + {"t":0.02741, "x":5.6871, "y":5.67225, "heading":-1.59166, "vx":2.74677, "vy":-1.2036, "omega":-0.96, "ax":-0.00261, "ay":-0.0061, "alpha":-0.43399, "fx":[-1.11005,0.97633,1.02745,-1.05958], "fy":[-1.25461,-1.36184,1.09249,1.13636]}, + {"t":0.05481, "x":5.76238, "y":5.63927, "heading":-1.61797, "vx":2.7467, "vy":-1.20377, "omega":-0.97189, "ax":0.01203, "ay":0.02747, "alpha":-0.38262, "fx":[-0.78283,1.06431,1.16489,-0.68254], "fy":[-0.57255,-0.68116,1.45504,1.54315]}, + {"t":0.08222, "x":5.83766, "y":5.60629, "heading":-1.6446, "vx":2.74703, "vy":-1.20302, "omega":-0.98238, "ax":0.01063, "ay":0.02429, "alpha":-0.34538, "fx":[-0.73327,0.92911,1.07088,-0.59176], "fy":[-0.49716,-0.64903,1.28231,1.40632]}, + {"t":0.10962, "x":5.91294, "y":5.57333, "heading":-1.67152, "vx":2.74732, "vy":-1.20235, "omega":-0.99184, "ax":-0.00045, "ay":-0.00101, "alpha":-0.31743, "fx":[-0.85903,0.66691,0.84496,-0.68128], "fy":[-0.80687,-0.98182,0.78447,0.93986]}, + {"t":0.13703, "x":5.98823, "y":5.54038, "heading":-1.6987, "vx":2.74731, "vy":-1.20238, "omega":-1.00054, "ax":-0.02304, "ay":-0.0526, "alpha":-0.29525, "fx":[-1.18823,0.24398,0.45682,-0.97576], "fy":[-1.57321,-1.71305,-0.11969,0.06569]}, + {"t":0.16443, "x":6.06352, "y":5.5074, "heading":-1.72612, "vx":2.74668, "vy":-1.20382, "omega":-1.00863, "ax":-0.06497, "ay":-0.14793, "alpha":-0.27824, "fx":[-1.8439,-0.46775,-0.21858,-1.5953], "fy":[-3.0663,-3.12635,-1.70893,-1.49222]}, + {"t":0.19184, "x":6.13876, "y":5.47436, "heading":-1.75377, "vx":2.7449, "vy":-1.20788, "omega":-1.01626, "ax":-0.13974, "ay":-0.31622, "alpha":-0.26533, "fx":[-3.03969,-1.68642,-1.39684,-2.75113], "fy":[-5.74653,-5.68327,-4.45158,-4.19972]}, + {"t":0.21924, "x":6.21394, "y":5.44114, "heading":-1.78162, "vx":2.74107, "vy":-1.21654, "omega":-1.02353, "ax":-0.26426, "ay":-0.59075, "alpha":-0.25407, "fx":[-5.0426,-3.68329,-3.347,-4.70841], "fy":[-10.14449,-9.89151,-8.88582,-8.5928]}, + {"t":0.24665, "x":6.28896, "y":5.40758, "heading":-1.80967, "vx":2.73382, "vy":-1.23273, "omega":-1.03049, "ax":-0.4628, "ay":-1.01268, "alpha":-0.24007, "fx":[-8.23607,-6.84707,-6.45581,-7.8499], "fy":[-16.92269,-16.36217,-15.68267,-15.34039]}, + {"t":0.27405, "x":6.3637, "y":5.37341, "heading":-1.83791, "vx":2.72114, "vy":-1.26048, "omega":-1.03707, "ax":-0.75395, "ay":-1.59099, "alpha":-0.21523, "fx":[-12.9065,-11.48039,-11.02572,-12.46559], "fy":[-26.24128,-25.16501,-25.01361,-24.61272]}, + {"t":0.30146, "x":6.438, "y":5.33827, "heading":-1.86633, "vx":2.70048, "vy":-1.30409, "omega":-1.04297, "ax":-2.64239, "ay":-1.67099, "alpha":-0.18728, "fx":[-42.78369,-41.55152,-41.09202,-42.37219], "fy":[-27.5244,-26.318,-26.36129,-25.90894]}, + {"t":0.32886, "x":6.51101, "y":5.3019, "heading":-1.89491, "vx":2.62806, "vy":-1.34988, "omega":-1.0481, "ax":-3.72972, "ay":1.3291, "alpha":-0.27932, "fx":[-59.95961,-58.98661,-58.45682,-59.44541], "fy":[20.55678,19.93487,21.78183,22.1284]}, + {"t":0.35627, "x":6.58163, "y":5.26541, "heading":-1.92364, "vx":2.52585, "vy":-1.31346, "omega":-1.05576, "ax":-3.69828, "ay":1.47018, "alpha":-0.27326, "fx":[-59.4727,-58.53295,-57.94235,-58.90347], "fy":[22.79834,22.22572,23.98971,24.34693]}, + {"t":0.38367, "x":6.64946, "y":5.22997, "heading":-1.95257, "vx":2.4245, "vy":-1.27317, "omega":-1.06325, "ax":-3.68739, "ay":1.51517, "alpha":-0.26704, "fx":[-59.29182,-58.39753,-57.7751,-58.69565], "fy":[23.54887,22.95176,24.67057,25.0463]}, + {"t":0.41108, "x":6.71452, "y":5.19564, "heading":-1.98171, "vx":2.32344, "vy":-1.23164, "omega":-1.07056, "ax":-3.68164, "ay":1.53787, "alpha":-0.25339, "fx":[-59.17277,-58.3406,-57.71034,-58.57104], "fy":[23.95268,23.36561,24.9765,25.36466]}, + {"t":0.43848, "x":6.77682, "y":5.16247, "heading":-2.01105, "vx":2.22255, "vy":-1.1895, "omega":-1.07751, "ax":-3.67811, "ay":1.55151, "alpha":-0.23292, "fx":[-59.07142,-58.31305,-57.70163,-58.48442], "fy":[24.21741,23.67334,25.1224,25.5123]}, + {"t":0.46589, "x":6.83634, "y":5.13045, "heading":-2.04058, "vx":2.12175, "vy":-1.14698, "omega":-1.08389, "ax":-3.67572, "ay":1.56062, "alpha":-0.20599, "fx":[-58.97137,-58.29853,-57.72969,-58.41912], "fy":[24.41235,23.9457,25.18367,25.56191]}, + {"t":0.49329, "x":6.89311, "y":5.0996, "heading":-2.07028, "vx":2.02101, "vy":-1.10421, "omega":-1.08954, "ax":-3.67404, "ay":1.56701, "alpha":-0.17665, "fx":[-58.86499,-58.29448,-57.78496,-58.36788], "fy":[24.57873,24.16697,25.20642,25.55742]}, + {"t":0.5207, "x":6.94712, "y":5.06993, "heading":-2.10014, "vx":1.92033, "vy":-1.06126, "omega":-1.09438, "ax":-3.67276, "ay":1.57183, "alpha":-0.14729, "fx":[-58.74703,-58.29784,-57.86039,-58.326], "fy":[24.74053,24.33091,25.21908,25.52516]}, + {"t":0.5481, "x":6.99837, "y":5.04144, "heading":-2.13013, "vx":1.81967, "vy":-1.01819, "omega":-1.09841, "ax":-3.67176, "ay":1.57558, "alpha":-0.11417, "fx":[-58.61718,-58.30358,-57.95354,-58.29344], "fy":[24.88797,24.49174,25.21628,25.45818]}, + {"t":0.57551, "x":7.04686, "y":5.01413, "heading":-2.16023, "vx":1.71905, "vy":-0.97501, "omega":-1.10154, "ax":-3.67096, "ay":1.5786, "alpha":-0.07287, "fx":[-58.47858,-58.29636,-58.06701,-58.27448], "fy":[25.00729,24.70644,25.18764,25.34426]}, + {"t":0.60292, "x":7.09259, "y":4.988, "heading":-2.19042, "vx":1.61844, "vy":-0.93175, "omega":-1.10354, "ax":-3.67031, "ay":1.58102, "alpha":-0.028, "fx":[-58.32776,-58.28378,-58.19713,-58.26683], "fy":[25.11732,24.92358,25.15519,25.20348]}, + {"t":0.63032, "x":7.13556, "y":4.96306, "heading":-2.22066, "vx":1.51786, "vy":-0.88842, "omega":-1.10431, "ax":-3.66977, "ay":1.58305, "alpha":0.02124, "fx":[-58.16335,-58.26352,-58.34347,-58.27066], "fy":[25.21791,25.15413,25.12,25.03645]}, + {"t":0.65773, "x":7.17578, "y":4.9393, "heading":-2.25093, "vx":1.41729, "vy":-0.84503, "omega":-1.10373, "ax":-3.66931, "ay":1.58477, "alpha":0.07666, "fx":[-57.9863,-58.22988,-58.50653,-58.28897], "fy":[25.30138,25.41813,25.08257,24.83566]}, + {"t":0.68513, "x":7.21325, "y":4.91674, "heading":-2.28118, "vx":1.31673, "vy":-0.8016, "omega":-1.10162, "ax":-3.66892, "ay":1.58623, "alpha":0.13353, "fx":[-57.79244,-58.18914,-58.68542,-58.32004], "fy":[25.38809,25.66015,25.06069,24.62123]}, + {"t":0.71254, "x":7.24795, "y":4.89537, "heading":-2.31137, "vx":1.21618, "vy":-0.75813, "omega":-1.09796, "ax":-3.66857, "ay":1.58751, "alpha":0.19853, "fx":[-57.58285,-58.13182,-58.88269,-58.36772], "fy":[25.45444,25.95222,25.0355,24.3694]}, + {"t":0.73994, "x":7.27991, "y":4.87519, "heading":-2.34146, "vx":1.11564, "vy":-0.71463, "omega":-1.09252, "ax":-3.66828, "ay":1.58862, "alpha":0.27041, "fx":[-57.35456,-58.05775,-59.10148,-58.4325], "fy":[25.5094,26.27536,25.00872,24.08827]}, + {"t":0.76735, "x":7.3091, "y":4.8562, "heading":-2.3714, "vx":1.01511, "vy":-0.67109, "omega":-1.08511, "ax":-3.66801, "ay":1.58959, "alpha":0.34551, "fx":[-57.10475,-57.97821,-59.33159,-58.5151], "fy":[25.55643,26.58736,25.01891,23.78111]}, + {"t":0.79475, "x":7.33554, "y":4.83841, "heading":-2.40113, "vx":0.91459, "vy":-0.62753, "omega":-1.07564, "ax":-3.66779, "ay":1.59045, "alpha":0.42905, "fx":[-56.8346,-57.8713,-59.58825,-58.62103], "fy":[25.58919,26.9369,25.03186,23.44017]}, + {"t":0.82216, "x":7.35923, "y":4.82181, "heading":-2.43061, "vx":0.81407, "vy":-0.58394, "omega":-1.06389, "ax":-3.66758, "ay":1.59122, "alpha":0.52574, "fx":[-56.54342,-57.73364,-59.87107,-58.75402], "fy":[25.58798,27.37019,25.04338,23.04537]}, + {"t":0.84956, "x":7.38016, "y":4.8064, "heading":-2.45977, "vx":0.71356, "vy":-0.54033, "omega":-1.04948, "ax":-3.6674, "ay":1.59191, "alpha":0.62977, "fx":[-56.22366,-57.57673,-60.17743,-58.91261], "fy":[25.57581,27.81611,25.08071,22.61817]}, + {"t":0.87697, "x":7.39834, "y":4.79219, "heading":-2.48853, "vx":0.61306, "vy":-0.4967, "omega":-1.03222, "ax":-3.66723, "ay":1.59253, "alpha":0.74205, "fx":[-55.87306,-57.39465,-60.51083,-59.10127], "fy":[25.55171,28.27473,25.14834,22.15572]}, + {"t":0.90437, "x":7.41377, "y":4.77918, "heading":-2.51682, "vx":0.51256, "vy":-0.45306, "omega":-1.01188, "ax":-3.66708, "ay":1.5931, "alpha":0.87038, "fx":[-55.49137,-57.17529,-60.877,-59.32649], "fy":[25.48913,28.82148,25.22595,21.63005]}, + {"t":0.93178, "x":7.42644, "y":4.76736, "heading":-2.54455, "vx":0.41206, "vy":-0.4094, "omega":-0.98803, "ax":-3.66694, "ay":1.59361, "alpha":1.01111, "fx":[-55.0723,-56.9226,-61.27642,-59.5902], "fy":[25.40374,29.40494,25.33538,21.05505]}, + {"t":0.95918, "x":7.43635, "y":4.75674, "heading":-2.57163, "vx":0.31156, "vy":-0.36573, "omega":-0.96032, "ax":-3.66682, "ay":1.59408, "alpha":1.16709, "fx":[-54.61252,-56.63007,-61.71324,-59.89778], "fy":[25.28788,30.04338,25.47649,20.42116]}, + {"t":0.98659, "x":7.44351, "y":4.74731, "heading":-2.59794, "vx":0.21107, "vy":-0.32204, "omega":-0.92834, "ax":-3.6667, "ay":1.59451, "alpha":1.34097, "fx":[-54.10756,-56.29308,-62.1912,-60.25448], "fy":[25.13426,30.75223,25.65053,19.7193]}, + {"t":1.01399, "x":7.44792, "y":4.73909, "heading":-2.62339, "vx":0.11059, "vy":-0.27834, "omega":-0.89159, "ax":-3.6666, "ay":1.59491, "alpha":1.53684, "fx":[-53.55392,-55.89862,-62.71968,-60.66753], "fy":[24.93439,31.56023,25.84834,18.93831]}, + {"t":1.0414, "x":7.44957, "y":4.73206, "heading":-2.64782, "vx":0.0101, "vy":-0.23464, "omega":-0.84947, "ax":-3.6665, "ay":1.59527, "alpha":1.75338, "fx":[-52.94301,-55.45503,-63.29502,-61.1406], "fy":[24.69187,32.43607,26.09732,18.07913]}, + {"t":1.0688, "x":7.44847, "y":4.72622, "heading":-2.6711, "vx":-0.09038, "vy":-0.19092, "omega":-0.80142, "ax":-3.70536, "ay":1.50068, "alpha":1.71433, "fx":[-53.69948,-56.09184,-63.77224,-61.73753], "fy":[22.95621,30.7144,24.85137,16.77551]}, + {"t":1.10769, "x":7.44216, "y":4.71994, "heading":-2.70226, "vx":-0.23446, "vy":-0.13256, "omega":-0.73476, "ax":-3.8062, "ay":1.22516, "alpha":1.43445, "fx":[-56.24918,-58.14372,-64.48397,-62.82831], "fy":[18.36613,25.2437,20.64964,13.54159]}, + {"t":1.14658, "x":7.43016, "y":4.71571, "heading":-2.73083, "vx":-0.38247, "vy":-0.08492, "omega":-0.67898, "ax":-3.9325, "ay":0.72048, "alpha":1.2155, "fx":[-58.98824,-60.60278,-65.80357,-64.33049], "fy":[10.1074,16.43055,12.76517,6.44977]}, + {"t":1.18546, "x":7.41232, "y":4.71295, "heading":-2.75724, "vx":-0.53539, "vy":-0.0569, "omega":-0.63171, "ax":-3.99544, "ay":0.1069, "alpha":1.0363, "fx":[-60.53448,-61.99963,-66.28738,-64.90059], "fy":[0.19821,6.02234,3.0557,-2.48791]}, + {"t":1.22435, "x":7.38848, "y":4.71082, "heading":-2.7818, "vx":-0.69075, "vy":-0.05275, "omega":-0.59141, "ax":-3.9889, "ay":-0.19977, "alpha":0.87321, "fx":[-60.86472,-62.13783,-65.76103,-64.54304], "fy":[-4.6193,0.39107,-1.84142,-6.61646]}, + {"t":1.26323, "x":7.3586, "y":4.70862, "heading":-2.8048, "vx":-0.84586, "vy":-0.06052, "omega":-0.55746, "ax":-3.90089, "ay":-0.14069, "alpha":0.76275, "fx":[-59.6989,-60.79739,-64.1364,-63.08524], "fy":[-3.51689,0.6729,-0.96329,-5.12703]}, + {"t":1.30212, "x":7.32276, "y":4.70616, "heading":-2.82648, "vx":-0.99755, "vy":-0.06599, "omega":-0.5278, "ax":0.00557, "ay":-0.08931, "alpha":0.87245, "fx":[3.0872,1.74438,-2.91141,-1.56632], "fy":[-2.64228,1.23711,-0.0934,-4.17277]}, + {"t":1.341, "x":7.28398, "y":4.70352, "heading":-2.847, "vx":-0.99733, "vy":-0.06946, "omega":-0.49387, "ax":0.00616, "ay":-0.08631, "alpha":0.7236, "fx":[2.56138,1.51952,-2.36717,-1.3227], "fy":[-2.43349,0.80828,-0.22968,-3.62632]}, + {"t":1.37989, "x":7.2452, "y":4.70076, "heading":-2.8662, "vx":-0.99709, "vy":-0.07282, "omega":-0.46574, "ax":0.00489, "ay":-0.06583, "alpha":0.6, "fx":[2.09814,1.28977,-1.94359,-1.1336], "fy":[-1.96807,0.7501,-0.06709,-2.89566]}, + {"t":1.41877, "x":7.20643, "y":4.69788, "heading":-2.88431, "vx":-0.9969, "vy":-0.07538, "omega":-0.4424, "ax":0.00406, "ay":-0.05301, "alpha":0.49874, "fx":[1.72414,1.09622,-1.59556,-0.96677], "fy":[-1.64282,0.64696,-0.00601,-2.36432]}, + {"t":1.45766, "x":7.16767, "y":4.6949, "heading":-2.90152, "vx":-0.99674, "vy":-0.07744, "omega":-0.42301, "ax":0.00349, "ay":-0.04444, "alpha":0.41605, "fx":[1.42377,0.93484,-1.31313,-0.82374], "fy":[-1.40099,0.53299,0.00915,-1.96353]}, + {"t":1.49654, "x":7.12891, "y":4.69186, "heading":-2.91797, "vx":-0.99661, "vy":-0.07917, "omega":-0.40683, "ax":0.00308, "ay":-0.03841, "alpha":0.34868, "fx":[1.18275,0.80083,-1.08508,-0.70291], "fy":[-1.21379,0.42472,0.00389,-1.65383]}, + {"t":1.53543, "x":7.09016, "y":4.68875, "heading":-2.93379, "vx":-0.99649, "vy":-0.08066, "omega":-0.39327, "ax":0.00278, "ay":-0.03406, "alpha":0.29456, "fx":[0.9915,0.69135,-0.9033,-0.60301], "fy":[-1.06799,0.3293,-0.01003,-1.41437]}, + {"t":1.57432, "x":7.05141, "y":4.68559, "heading":-2.94908, "vx":-0.99638, "vy":-0.08198, "omega":-0.38182, "ax":0.00256, "ay":-0.03082, "alpha":0.25155, "fx":[0.84098,0.60311,-0.75989,-0.52195], "fy":[-0.95337,0.24988,-0.02564,-1.22834]}, + {"t":1.6132, "x":7.01267, "y":4.68238, "heading":-2.96393, "vx":-0.99628, "vy":-0.08318, "omega":-0.37204, "ax":0.00238, "ay":-0.02833, "alpha":0.2184, "fx":[0.72545,0.53441,-0.64986,-0.45877], "fy":[-0.86405,0.18826,-0.03813,-1.0853]}, + {"t":1.65209, "x":6.97393, "y":4.67912, "heading":-2.97839, "vx":-0.99619, "vy":-0.08428, "omega":-0.36354, "ax":0.00225, "ay":-0.0264, "alpha":0.19373, "fx":[0.63939,0.48324,-0.56806,-0.41188], "fy":[-0.79619,0.14326,-0.04592,-0.97733]}, + {"t":1.69097, "x":6.9352, "y":4.67582, "heading":-2.99253, "vx":-0.9961, "vy":-0.08531, "omega":-0.35601, "ax":0.00215, "ay":-0.02491, "alpha":0.17691, "fx":[0.57983,0.44907,-0.51172,-0.38094], "fy":[-0.74828,0.11426,-0.04747,-0.90019]}, + {"t":1.72986, "x":6.89646, "y":4.67249, "heading":-3.00637, "vx":-0.99602, "vy":-0.08628, "omega":-0.34913, "ax":0.00207, "ay":-0.0238, "alpha":0.1672, "fx":[0.54373,0.43109,-0.47792,-0.36526], "fy":[-0.71896,0.09968,-0.0422,-0.84993]}, + {"t":1.76874, "x":6.85774, "y":4.66912, "heading":-3.01995, "vx":-0.99594, "vy":-0.0872, "omega":-0.34263, "ax":0.00203, "ay":-0.02303, "alpha":0.16449, "fx":[0.53003,0.42979,-0.46569,-0.36543], "fy":[-0.70824,0.09953,-0.02871,-0.82484]}, + {"t":1.80763, "x":6.81901, "y":4.66571, "heading":-3.03327, "vx":-0.99586, "vy":-0.0881, "omega":-0.33623, "ax":0.00201, "ay":-0.02255, "alpha":0.16863, "fx":[0.53769,0.44562,-0.47403,-0.38195], "fy":[-0.71616,0.11311,-0.00583,-0.8232]}, + {"t":1.84651, "x":6.78029, "y":4.66226, "heading":-3.04635, "vx":-0.99578, "vy":-0.08898, "omega":-0.32968, "ax":0.00201, "ay":-0.02235, "alpha":0.17999, "fx":[0.5672,0.48021,-0.50348,-0.41647], "fy":[-0.74408,0.14142,0.02828,-0.84513]}, + {"t":1.8854, "x":6.74157, "y":4.65879, "heading":-3.05917, "vx":-0.9957, "vy":-0.08985, "omega":-0.32268, "ax":0.00203, "ay":-0.02242, "alpha":0.19904, "fx":[0.6194,0.53551,-0.55485,-0.47094], "fy":[-0.79359,0.18477,0.07574,-0.8909]}, + {"t":1.92429, "x":6.70285, "y":4.65528, "heading":-3.07171, "vx":-0.99562, "vy":-0.09072, "omega":-0.31494, "ax":0.00208, "ay":-0.02277, "alpha":0.22671, "fx":[0.69635,0.61462,-0.63018,-0.54842], "fy":[-0.86767,0.24515,0.13919,-0.96235]}, + {"t":1.96317, "x":6.66414, "y":4.65173, "heading":-3.08396, "vx":-0.99554, "vy":-0.0916, "omega":-0.30612, "ax":0.00216, "ay":-0.0234, "alpha":0.26415, "fx":[0.80091,0.72146,-0.73224,-0.65275], "fy":[-0.96996,0.32406,0.22209,-1.06186]}, + {"t":2.00206, "x":6.62543, "y":4.64815, "heading":-3.09586, "vx":-0.99546, "vy":-0.09251, "omega":-0.29585, "ax":0.00227, "ay":-0.02434, "alpha":0.31297, "fx":[0.93699,0.86108,-0.86481,-0.78884], "fy":[-1.1055,0.42443,0.32834,-1.19323]}, + {"t":2.04094, "x":6.58672, "y":4.64454, "heading":-3.10737, "vx":-0.99537, "vy":-0.09346, "omega":-0.28368, "ax":0.00242, "ay":-0.02566, "alpha":0.37526, "fx":[1.10996,1.0401,-1.03311,-0.96314], "fy":[-1.28066,0.54926,0.4634,-1.36138]}, + {"t":2.07983, "x":6.54802, "y":4.64088, "heading":-3.1184, "vx":-0.99527, "vy":-0.09446, "omega":-0.26909, "ax":0.00261, "ay":-0.02739, "alpha":0.45348, "fx":[1.32618,1.26629,-1.24328,-1.18321], "fy":[-1.50288,0.70252,0.63344,-1.57214]}, + {"t":2.11871, "x":6.50932, "y":4.63719, "heading":-3.12886, "vx":-0.99517, "vy":-0.09552, "omega":-0.25145, "ax":0.00286, "ay":-0.02958, "alpha":0.55099, "fx":[1.59446,1.54999,-1.50392,-1.45913], "fy":[-1.78173,0.88934,0.84724,-1.83339]}, + {"t":2.1576, "x":6.47062, "y":4.63345, "heading":-3.13864, "vx":-0.99506, "vy":-0.09667, "omega":-0.23003, "ax":0.00317, "ay":-0.03237, "alpha":0.67147, "fx":[1.92472,1.90287,-1.82453,-1.80206], "fy":[-2.12858,1.1141,1.11363,-2.15456]}, + {"t":2.19648, "x":6.43193, "y":4.62967, "heading":3.1356, "vx":-0.99494, "vy":-0.09793, "omega":-0.20392, "ax":0.00358, "ay":-0.03608, "alpha":0.82007, "fx":[2.33116,2.34084,-2.21825,-2.22659], "fy":[-2.56177,1.38118,1.44145,-2.5522]}, + {"t":2.23537, "x":6.39324, "y":4.62583, "heading":3.12767, "vx":-0.9948, "vy":-0.09933, "omega":-0.17203, "ax":0.00417, "ay":-0.04144, "alpha":1.00232, "fx":[2.82999,2.8819,-2.69907,-2.74789], "fy":[-3.10627,1.68987,1.83448,-3.04972]}, + {"t":2.27425, "x":6.35456, "y":4.62194, "heading":3.12098, "vx":-0.99464, "vy":-0.10095, "omega":-0.13305, "ax":0.00504, "ay":-0.04917, "alpha":1.22595, "fx":[3.44316,3.5496,-3.28693,-3.38593], "fy":[-3.79231,2.04741,2.29955,-3.67698]}, + {"t":2.31314, "x":6.31589, "y":4.61798, "heading":3.11581, "vx":-0.99444, "vy":-0.10286, "omega":-0.08538, "ax":0.00617, "ay":-0.05901, "alpha":1.49925, "fx":[4.19309,4.36777,-4.00584,-4.16308], "fy":[-4.63504,2.4814,2.85754,-4.45115]}, + {"t":2.35203, "x":6.27723, "y":4.61393, "heading":3.11249, "vx":-0.9942, "vy":-0.10515, "omega":-0.02708, "ax":0.00784, "ay":-0.07311, "alpha":1.83416, "fx":[5.11396,5.37101,-4.88371,-5.10356], "fy":[-5.69728,3.00603,3.4913,-5.44254]}, + {"t":2.39091, "x":6.23857, "y":4.60979, "heading":3.11143, "vx":-0.9939, "vy":-0.10799, "omega":0.04424, "ax":0.01312, "ay":-0.11818, "alpha":2.24746, "fx":[6.29131,6.63648,-5.90599,-6.18881], "fy":[-7.45424,3.29963,3.79061,-7.14086]}, + {"t":2.4298, "x":6.19993, "y":4.6055, "heading":3.11315, "vx":-0.99339, "vy":-0.11259, "omega":0.13163, "ax":0.01922, "ay":-0.16371, "alpha":2.75844, "fx":[7.73421,8.08411,-7.12628,-7.47165], "fy":[-9.52357,4.0404,4.24658,-9.15921]}, + {"t":2.46868, "x":6.16132, "y":4.601, "heading":3.11827, "vx":-0.99264, "vy":-0.11896, "omega":0.2389, "ax":3.49973, "ay":0.98163, "alpha":2.448, "fx":[62.23666,61.04682,48.95791,50.00149], "fy":[8.06703,21.35547,23.30028,9.61355]}, + {"t":2.50757, "x":6.12537, "y":4.59711, "heading":3.12756, "vx":-0.85655, "vy":-0.08079, "omega":0.33409, "ax":1.92212, "ay":3.50384, "alpha":2.76181, "fx":[40.24377,37.57129,21.26512,22.98011], "fy":[48.31785,59.94376,63.01872,51.22381]}, + {"t":2.54645, "x":6.09351, "y":4.59662, "heading":3.14055, "vx":-0.78181, "vy":0.05546, "omega":0.44148, "ax":1.30148, "ay":3.78095, "alpha":3.3132, "fx":[32.66584,29.64769,9.56309,10.77122], "fy":[52.22164,65.33507,67.80318,54.74154]}, + {"t":2.58534, "x":6.06409, "y":4.60164, "heading":-3.12547, "vx":-0.7312, "vy":0.20249, "omega":0.57032, "ax":1.20737, "ay":3.80968, "alpha":2.05716, "fx":[26.59215,24.83096,12.10027,13.14797], "fy":[55.81846,63.86969,65.16058,57.07706]}, + {"t":2.60766, "x":6.04808, "y":4.60711, "heading":-3.11274, "vx":-0.70425, "vy":0.28752, "omega":0.61623, "ax":1.20232, "ay":3.81305, "alpha":1.95927, "fx":[26.20369,24.41859,12.28065,13.44818], "fy":[56.14535,63.82674,64.94643,57.22137]}, + {"t":2.62998, "x":6.03266, "y":4.61447, "heading":-3.09898, "vx":-0.67742, "vy":0.37262, "omega":0.65996, "ax":1.19612, "ay":3.81489, "alpha":1.90122, "fx":[25.93952,24.09239,12.32448,13.60073], "fy":[56.35839,63.83587,64.79123,57.27131]}, + {"t":2.6523, "x":6.01783, "y":4.62374, "heading":-3.08425, "vx":-0.65072, "vy":0.45777, "omega":0.7024, "ax":1.18918, "ay":3.81694, "alpha":1.86417, "fx":[25.73502,23.81062,12.28268,13.68838], "fy":[56.53732,63.88755,64.68491,57.27689]}, + {"t":2.67462, "x":6.00361, "y":4.63491, "heading":-3.06857, "vx":-0.62418, "vy":0.54296, "omega":0.744, "ax":1.18138, "ay":3.81922, "alpha":1.84388, "fx":[25.58199,23.56396,12.16525,13.70992], "fy":[56.70197,63.96115,64.61658,57.2521]}, + {"t":2.69694, "x":5.98997, "y":4.64798, "heading":-3.05197, "vx":-0.59781, "vy":0.6282, "omega":0.78516, "ax":1.17253, "ay":3.82179, "alpha":1.84282, "fx":[25.49214,23.33712,11.96508,13.6649], "fy":[56.82432,64.07807,64.59069,57.2019]}, + {"t":2.71926, "x":5.97692, "y":4.66295, "heading":-3.03444, "vx":-0.57164, "vy":0.7135, "omega":0.82629, "ax":1.16242, "ay":3.8247, "alpha":1.86212, "fx":[25.46002,23.13893,11.66447,13.55343], "fy":[56.91757,64.23539,64.6114,57.1155]}, + {"t":2.74157, "x":5.96445, "y":4.67983, "heading":-3.016, "vx":-0.5457, "vy":0.79887, "omega":0.86785, "ax":1.15074, "ay":3.82803, "alpha":1.90182, "fx":[25.48538,22.94432,11.27005,13.37551], "fy":[56.97944,64.46665,64.66066,56.98424]}, + {"t":2.76389, "x":5.95256, "y":4.69861, "heading":-2.99663, "vx":-0.52001, "vy":0.88431, "omega":0.9103, "ax":1.13711, "ay":3.83186, "alpha":1.9616, "fx":[25.56348,22.76047,10.76101,13.12461], "fy":[57.02397,64.7284,64.7673,56.81472]}, + {"t":2.78621, "x":5.94123, "y":4.7193, "heading":-2.97632, "vx":-0.49463, "vy":0.96984, "omega":0.95408, "ax":1.12098, "ay":3.83633, "alpha":2.04139, "fx":[25.68834,22.57925,10.13328,12.78492], "fy":[57.05421,65.05418,64.89242,56.61718]}, + {"t":2.80853, "x":5.93047, "y":4.74191, "heading":-2.95502, "vx":-0.46961, "vy":1.05546, "omega":0.99964, "ax":1.10162, "ay":3.84159, "alpha":2.14763, "fx":[25.87208,22.33843,9.36776,12.37811], "fy":[57.06253,65.51426,65.05057,56.3251]}, + {"t":2.83085, "x":5.92027, "y":4.76642, "heading":-2.93271, "vx":-0.44502, "vy":1.1412, "omega":1.04758, "ax":1.07794, "ay":3.84789, "alpha":2.28034, "fx":[26.09859,22.06113,8.43644,11.85645], "fy":[57.0549,66.08149,65.23418,55.98203]}, + {"t":2.85317, "x":5.9106, "y":4.79285, "heading":-2.90933, "vx":-0.42097, "vy":1.22709, "omega":1.09847, "ax":1.04832, "ay":3.85556, "alpha":2.43112, "fx":[26.32114,21.77251,7.28957,11.18818], "fy":[57.10902,66.61431,65.48793,55.62806]}, + {"t":2.87549, "x":5.90147, "y":4.8212, "heading":-2.88481, "vx":-0.39757, "vy":1.31314, "omega":1.15273, "ax":1.01021, "ay":3.86507, "alpha":2.60919, "fx":[26.53621,21.39592,5.87774,10.34112], "fy":[57.19605,67.22211,65.79686,55.22802]}, + {"t":2.89781, "x":5.89285, "y":4.85147, "heading":-2.85908, "vx":-0.37502, "vy":1.39941, "omega":1.21097, "ax":0.95936, "ay":3.87713, "alpha":2.83381, "fx":[26.73655,20.781,4.14422,9.2605], "fy":[57.26709,68.15953,66.09729,54.68536]}, + {"t":2.92013, "x":5.88471, "y":4.88367, "heading":-2.83205, "vx":-0.35361, "vy":1.48594, "omega":1.27422, "ax":0.8882, "ay":3.89285, "alpha":3.09415, "fx":[26.76865,19.90758,1.9303,7.79664], "fy":[57.4548,69.23309,66.44893,54.0705]}, + {"t":2.94245, "x":5.87704, "y":4.9178, "heading":-2.80361, "vx":-0.33378, "vy":1.57283, "omega":1.34328, "ax":0.78167, "ay":3.91385, "alpha":3.39059, "fx":[26.43954,18.54457,-1.02179,5.67628], "fy":[57.82449,70.399,66.8936,53.42401]}, + {"t":2.96477, "x":5.86979, "y":4.95388, "heading":-2.77363, "vx":-0.31634, "vy":1.66018, "omega":1.41895, "ax":0.60542, "ay":3.94208, "alpha":3.72741, "fx":[25.23712,16.20727,-5.27182,2.27341], "fy":[58.42068,71.76344,67.30773,52.84151]}, + {"t":2.98709, "x":5.86288, "y":4.99192, "heading":-2.74196, "vx":-0.30282, "vy":1.74817, "omega":1.50215, "ax":0.26179, "ay":3.97422, "alpha":4.17026, "fx":[21.61461,11.42557,-12.28847,-4.12717], "fy":[59.51142,73.79085,67.48733,51.58523]}, + {"t":3.00941, "x":5.85618, "y":5.03193, "heading":-2.70843, "vx":-0.29698, "vy":1.83687, "omega":1.59523, "ax":-0.64461, "ay":3.91638, "alpha":4.71957, "fx":[8.96479,-1.78211,-27.81897,-20.29845], "fy":[59.9169,75.29966,65.67337,47.81154]}, + {"t":3.03173, "x":5.8494, "y":5.0739, "heading":-2.67283, "vx":-0.31137, "vy":1.92428, "omega":1.70057, "ax":-3.60202, "ay":1.58478, "alpha":5.24017, "fx":[-39.90676,-49.63325,-72.6241,-66.57472], "fy":[22.07913,45.38599,28.37562,4.79717]}, + {"t":3.05405, "x":5.84155, "y":5.11725, "heading":-2.63487, "vx":-0.39176, "vy":1.95965, "omega":1.81752, "ax":-3.8631, "ay":-0.88222, "alpha":5.60898, "fx":[-42.81927,-57.51082,-78.29124,-66.69708], "fy":[-21.52584,9.41734,-8.52696,-35.38811]}, + {"t":3.07637, "x":5.83184, "y":5.16076, "heading":-2.59431, "vx":-0.47799, "vy":1.93996, "omega":1.94271, "ax":-3.80296, "ay":-1.0107, "alpha":5.42921, "fx":[-41.84545,-57.52599,-77.30658,-64.82134], "fy":[-22.65759,6.36278,-11.30544,-36.58192]}, + {"t":3.09816, "x":5.82052, "y":5.2028, "heading":-2.55197, "vx":-0.56087, "vy":1.91794, "omega":2.06103, "ax":-3.22124, "ay":-2.30936, "alpha":4.43715, "fx":[-34.57155,-50.20529,-66.68439,-53.09725], "fy":[-42.53797,-19.46123,-32.54509,-52.10677]}, + {"t":3.11995, "x":5.80753, "y":5.24405, "heading":-2.50705, "vx":-0.63107, "vy":1.86761, "omega":2.15773, "ax":-1.26096, "ay":-3.7678, "alpha":3.71461, "fx":[-4.6038,-18.52267,-35.15783,-21.79031], "fy":[-63.15271,-47.18957,-58.0035,-70.92027]}, + {"t":3.14175, "x":5.79348, "y":5.28386, "heading":-2.46003, "vx":-0.65855, "vy":1.78549, "omega":2.23869, "ax":-0.08171, "ay":-3.98113, "alpha":2.94995, "fx":[11.17219,0.57984,-13.83839,-3.10225], "fy":[-64.18475,-53.73502,-63.07425,-71.81933]}, + {"t":3.16354, "x":5.77911, "y":5.32183, "heading":-2.41124, "vx":-0.66033, "vy":1.69873, "omega":2.30298, "ax":0.50555, "ay":-3.9547, "alpha":2.2308, "fx":[17.45428,9.49848,-1.51069,6.66201], "fy":[-62.65111,-55.72937,-63.36005,-69.3946]}, + {"t":3.18533, "x":5.76484, "y":5.35791, "heading":-2.36105, "vx":-0.64931, "vy":1.61255, "omega":2.3516, "ax":0.83509, "ay":-3.90142, "alpha":1.57775, "fx":[19.8408,14.15639,6.59823,12.43553], "fy":[-61.43325,-56.85005,-62.76085,-66.70769]}, + {"t":3.20713, "x":5.75089, "y":5.39212, "heading":-2.3098, "vx":-0.63111, "vy":1.52752, "omega":2.38598, "ax":1.04178, "ay":-3.85334, "alpha":0.93237, "fx":[20.45542,16.92012,12.59597,16.18487], "fy":[-60.60063,-58.25361,-61.80729,-64.03689]}, + {"t":3.22892, "x":5.73738, "y":5.4245, "heading":-2.2578, "vx":-0.60841, "vy":1.44354, "omega":2.4063, "ax":1.18236, "ay":-3.81393, "alpha":0.31859, "fx":[20.10364,18.83585,17.42619,18.71771], "fy":[-60.27467,-59.57825,-60.78943,-61.55312]}, + {"t":3.25071, "x":5.7244, "y":5.45505, "heading":-2.20536, "vx":-0.58264, "vy":1.36042, "omega":2.41324, "ax":1.28377, "ay":-3.78201, "alpha":-0.27097, "fx":[19.1723,20.37483,21.55982,20.41604], "fy":[-60.37804,-60.79044,-59.74473,-59.25558]}, + {"t":3.27251, "x":5.71201, "y":5.4838, "heading":-2.15277, "vx":-0.55466, "vy":1.278, "omega":2.40734, "ax":1.36021, "ay":-3.75597, "alpha":-0.87561, "fx":[17.84903,21.75127,25.2845,21.49236], "fy":[-60.81054,-62.1527,-58.54858,-57.00352]}, + {"t":3.2943, "x":5.70024, "y":5.51076, "heading":-2.1003, "vx":-0.52502, "vy":1.19614, "omega":2.38825, "ax":1.41982, "ay":-3.73446, "alpha":-1.50352, "fx":[16.2483,23.06644,28.78784,22.05988], "fy":[-61.55841,-63.62667,-57.18968,-54.77461]}, + {"t":3.31609, "x":5.68914, "y":5.53594, "heading":-2.04825, "vx":-0.49408, "vy":1.11476, "omega":2.35549, "ax":1.46756, "ay":-3.71646, "alpha":-2.16445, "fx":[14.42389,24.43402,32.17798,22.1586], "fy":[-62.61948,-65.19526,-55.648,-52.54322]}, + {"t":3.33789, "x":5.67872, "y":5.55936, "heading":-1.99692, "vx":-0.46209, "vy":1.03376, "omega":2.30832, "ax":1.50665, "ay":-3.7012, "alpha":-2.86879, "fx":[12.41842,25.91443,35.53558,21.80808], "fy":[-63.99874,-66.86324,-53.88729,-50.28759]}, + {"t":3.35968, "x":5.66901, "y":5.58101, "heading":-1.94661, "vx":-0.42926, "vy":0.9531, "omega":2.2458, "ax":1.53922, "ay":-3.68812, "alpha":-3.61183, "fx":[10.27051,27.58123,38.89732,20.99589], "fy":[-65.72463,-68.49879,-51.93546,-48.04729]}, + {"t":3.38148, "x":5.66002, "y":5.6009, "heading":-1.89767, "vx":-0.39571, "vy":0.87272, "omega":2.16708, "ax":1.56677, "ay":-3.67679, "alpha":-4.39709, "fx":[8.01459,29.50024,42.2839,19.69607], "fy":[-67.78161,-70.07828,-49.77511,-45.8519]}, + {"t":3.40327, "x":5.65177, "y":5.61905, "heading":-1.85044, "vx":-0.36157, "vy":0.79259, "omega":2.07125, "ax":1.59038, "ay":-3.66689, "alpha":-5.23235, "fx":[5.73425,31.62466,45.72683,17.90836], "fy":[-70.10033,-71.70381,-47.37974,-43.67456]}, + {"t":3.42506, "x":5.64426, "y":5.63545, "heading":-1.8053, "vx":-0.32691, "vy":0.71268, "omega":1.95722, "ax":1.61084, "ay":-3.65818, "alpha":-6.12225, "fx":[3.47751,33.90649,49.26613,15.64279], "fy":[-72.69503,-73.38273,-44.72254,-41.50456]}, + {"t":3.44686, "x":5.63752, "y":5.65011, "heading":-1.76265, "vx":-0.2918, "vy":0.63296, "omega":1.8238, "ax":1.62872, "ay":-3.65044, "alpha":-7.05657, "fx":[1.30981,36.33138,52.89449,12.8931], "fy":[-75.50357,-75.0781,-41.82074,-39.4113]}, + {"t":3.46865, "x":5.63155, "y":5.66304, "heading":-1.7229, "vx":-0.25631, "vy":0.5534, "omega":1.67001, "ax":1.6445, "ay":-3.64353, "alpha":-8.01922, "fx":[-0.71965,38.92977,56.55413,9.66615], "fy":[-78.46041,-76.70216,-38.77552,-37.43705]}, + {"t":3.49044, "x":5.62635, "y":5.67424, "heading":-1.68651, "vx":-0.22047, "vy":0.474, "omega":1.49524, "ax":1.65851, "ay":-3.63733, "alpha":-9.00048, "fx":[-2.5631,41.6342,60.2517,5.9973], "fy":[-81.49416,-78.25154,-35.60343,-35.63213]}, + {"t":3.51224, "x":5.62194, "y":5.6837, "heading":-1.65392, "vx":-0.18432, "vy":0.39473, "omega":1.29909, "ax":1.67103, "ay":-3.63173, "alpha":-9.99246, "fx":[-4.19706,44.3634,63.97307,1.97613], "fy":[-84.54475,-79.76039,-32.36054,-33.95997]}, + {"t":3.53403, "x":5.61832, "y":5.69144, "heading":-1.62561, "vx":-0.1479, "vy":0.31558, "omega":1.08132, "ax":1.6823, "ay":-3.62665, "alpha":-10.97998, "fx":[-5.61773,47.06386,67.70654,-2.32187], "fy":[-87.53552,-81.20448,-29.09058,-32.47251]}, + {"t":3.55582, "x":5.6155, "y":5.69746, "heading":-1.60204, "vx":-0.11124, "vy":0.23654, "omega":0.84203, "ax":1.69248, "ay":-3.62203, "alpha":-11.95113, "fx":[-6.85019,49.66417,71.41424,-6.75092], "fy":[-90.42785,-82.59564,-25.92561,-31.06014]}, + {"t":3.57762, "x":5.61348, "y":5.70175, "heading":-1.58369, "vx":-0.07436, "vy":0.1576, "omega":0.58157, "ax":1.70172, "ay":-3.61779, "alpha":-12.89664, "fx":[-7.94224,52.10203,75.094,-11.18942], "fy":[-93.17083,-83.96359,-22.91674,-29.68935]}, + {"t":3.59941, "x":5.61226, "y":5.70433, "heading":-1.57102, "vx":-0.03727, "vy":0.07876, "omega":0.30051, "ax":1.71016, "ay":-3.61391, "alpha":-13.78912, "fx":[-9.19603,54.22791,78.6126,-15.04422], "fy":[-95.74336,-85.33114,-20.13289,-28.28626]}, + {"t":3.6212, "x":5.61185, "y":5.70519, "heading":-1.56447, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + "splits":[0] + }, + "events":[ + {"name":"IntakeDown", "from":{"target":0, "targetTimestamp":0.0, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeDown"}}}, + {"name":"IntakeUp", "from":{"target":3, "targetTimestamp":3.07637, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] +} diff --git a/src/main/deploy/choreo/LeftShoot.traj b/src/main/deploy/choreo/LeftShoot.traj index 12a31fc5..a05beba4 100644 --- a/src/main/deploy/choreo/LeftShoot.traj +++ b/src/main/deploy/choreo/LeftShoot.traj @@ -3,26 +3,28 @@ "version":3, "snapshot":{ "waypoints":[ - {"x":3.599256992340088, "y":5.614581108093262, "heading":4.71238898038469, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.260087728500366, "y":5.023375511169434, "heading":2.4031239516930234, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":3.599256992340088, "y":5.614581108093262, "heading":4.71238898038469, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2884325981140137, "y":5.549228191375732, "heading":2.1236372236423873, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":5.0}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":5.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"3.599256992340088 m", "val":3.599256992340088}, "y":{"exp":"5.614581108093262 m", "val":5.614581108093262}, "heading":{"exp":"270 deg", "val":4.71238898038469}, "intervals":25, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.260087728500366 m", "val":3.260087728500366}, "y":{"exp":"5.023375511169434 m", "val":5.023375511169434}, "heading":{"exp":"2.4031239516930234 rad", "val":2.4031239516930234}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"3.599256992340088 m", "val":3.599256992340088}, "y":{"exp":"5.614581108093262 m", "val":5.614581108093262}, "heading":{"exp":"270 deg", "val":4.71238898038469}, "intervals":32, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2884325981140137 m", "val":3.2884325981140137}, "y":{"exp":"5.549228191375732 m", "val":5.549228191375732}, "heading":{"exp":"2.1236372236423873 rad", "val":2.1236372236423873}, "intervals":40, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":{"exp":"5 m / s", "val":5.0}}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"8 m / s ^ 2", "val":8.0}}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"8 m / s ^ 2", "val":8.0}}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"5 rad / s", "val":5.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -53,34 +55,41 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,0.67154], + "waypoints":[0.0,0.6561], "samples":[ - {"t":0.0, "x":3.59926, "y":5.61458, "heading":-1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.07603, "ay":-5.39487, "alpha":-20.65895, "fx":[-85.62782,3.36702,85.0019,-134.57493], "fy":[-104.0238,-134.65329,-99.13792,-4.77526]}, - {"t":0.02686, "x":3.59851, "y":5.61263, "heading":-1.5708, "vx":-0.05577, "vy":-0.14491, "omega":-0.55493, "ax":-2.47051, "ay":-5.67032, "alpha":-18.63969, "fx":[-85.61107,2.56387,60.67256,-134.50992], "fy":[-104.02134,-134.65473,-115.48962,-5.91623]}, - {"t":0.05372, "x":3.59612, "y":5.6067, "heading":-1.5857, "vx":-0.12213, "vy":-0.29723, "omega":-1.05562, "ax":-2.62993, "ay":-5.72715, "alpha":-18.10103, "fx":[-86.38528,0.91689,52.94886,-134.48879], "fy":[-103.35968,-134.65776,-119.86245,-5.81121]}, - {"t":0.08058, "x":3.59189, "y":5.59665, "heading":-1.61406, "vx":-0.19277, "vy":-0.45107, "omega":-1.54184, "ax":-2.65123, "ay":-5.68378, "alpha":-18.37322, "fx":[-87.8276,-1.50332,55.4674,-134.49752], "fy":[-102.11284,-134.63158,-119.45963,-4.73291]}, - {"t":0.10745, "x":3.58575, "y":5.58248, "heading":-1.65547, "vx":-0.26399, "vy":-0.60374, "omega":-2.03537, "ax":-2.6491, "ay":-5.58939, "alpha":-18.96928, "fx":[-89.89298,-4.65996,60.83598,-134.50889], "fy":[-100.26885,-134.53454,-117.42808,-2.7113]}, - {"t":0.13431, "x":3.57771, "y":5.56425, "heading":-1.71015, "vx":-0.33514, "vy":-0.75388, "omega":-2.54491, "ax":-2.67768, "ay":-5.46668, "alpha":-19.64744, "fx":[-92.55262,-8.55793,65.54471,-134.47489], "fy":[-97.77896,-134.3124,-115.31425,0.25547]}, - {"t":0.16117, "x":3.56774, "y":5.54202, "heading":-1.77851, "vx":-0.40707, "vy":-0.90072, "omega":-3.07267, "ax":-2.75607, "ay":-5.32655, "alpha":-20.29162, "fx":[-95.78453,-13.25003,68.33894,-134.323], "fy":[-94.55949,-133.89143,-113.97794,4.17729]}, - {"t":0.18803, "x":3.55581, "y":5.51591, "heading":-1.86104, "vx":-0.4811, "vy":-1.0438, "omega":-3.61773, "ax":-2.88565, "ay":-5.17056, "alpha":-20.85673, "fx":[-99.54743,-18.78744,69.0387,-133.95095], "fy":[-90.50755,-133.17283,-113.71649,9.05142]}, - {"t":0.21489, "x":3.54185, "y":5.486, "heading":-1.95822, "vx":-0.55862, "vy":-1.18269, "omega":-4.17797, "ax":-3.06476, "ay":-4.99554, "alpha":-21.30998, "fx":[-103.78326,-25.24762,67.62601,-133.21669], "fy":[-85.48582,-132.01893,-114.58408,14.85729]}, - {"t":0.24175, "x":3.52574, "y":5.45243, "heading":-2.07045, "vx":-0.64094, "vy":-1.31688, "omega":-4.75039, "ax":-3.28974, "ay":-4.79361, "alpha":-21.6229, "fx":[-108.40679,-32.71371,64.11877,-131.90658], "fy":[-79.30222,-130.23247,-116.42087,21.54703]}, - {"t":0.26861, "x":3.50733, "y":5.41533, "heading":-2.19805, "vx":-0.72931, "vy":-1.44564, "omega":-5.33121, "ax":-3.56005, "ay":-4.54947, "alpha":-21.74502, "fx":[-113.31319,-41.38775,58.21623,-129.58876], "fy":[-71.58746,-127.46098,-118.95955,29.10342]}, - {"t":0.29548, "x":3.48646, "y":5.37486, "heading":-2.34125, "vx":-0.82493, "vy":-1.56785, "omega":-5.91531, "ax":-3.8883, "ay":-4.20428, "alpha":-21.55782, "fx":[-118.43015,-52.15921,48.24746,-124.5767], "fy":[-60.94558,-122.58209,-121.50505,38.04879]}, - {"t":0.32234, "x":3.4629, "y":5.33123, "heading":-2.50015, "vx":-0.92938, "vy":-1.68078, "omega":-6.49438, "ax":-5.01589, "ay":1.33279, "alpha":-7.40385, "fx":[-98.36599,-89.77123,-57.12926,-73.25696], "fy":[20.21662,-11.86361,21.98772,54.29554]}, - {"t":0.3492, "x":3.43612, "y":5.28656, "heading":-2.67459, "vx":-1.06411, "vy":-1.64498, "omega":-6.69326, "ax":3.96914, "ay":4.09771, "alpha":20.45711, "fx":[122.86178,61.2279,-45.55374,113.51605], "fy":[50.51476,118.31292,123.98081,-32.59204]}, - {"t":0.37606, "x":3.40897, "y":5.24385, "heading":-2.85438, "vx":-0.9575, "vy":-1.53491, "omega":-6.14375, "ax":4.30185, "ay":4.90202, "alpha":16.01122, "fx":[128.46177,74.18538,-32.07161,102.60439], "fy":[37.44897,111.65501,129.69814,32.49025]}, - {"t":0.40292, "x":3.3848, "y":5.20439, "heading":-3.01941, "vx":-0.84194, "vy":-1.40323, "omega":-5.71367, "ax":2.28104, "ay":5.96532, "alpha":18.13232, "fx":[131.45797,84.23056,-19.50974,-51.32637], "fy":[26.56965,104.63471,132.66516,114.94576]}, - {"t":0.42978, "x":3.36301, "y":5.16885, "heading":3.11029, "vx":-0.78067, "vy":-1.243, "omega":-5.22661, "ax":2.3041, "ay":5.68422, "alpha":20.3641, "fx":[133.12113,92.11155,-8.75104,-70.16449], "fy":[17.43553,97.94936,134.03865,111.54093]}, - {"t":0.45664, "x":3.34287, "y":5.13751, "heading":2.9699, "vx":-0.71878, "vy":-1.09031, "omega":-4.6796, "ax":2.57881, "ay":5.49217, "alpha":21.26729, "fx":[134.00547,98.67375,0.93415,-69.85117], "fy":[9.4254,91.44818,134.45131,113.44382]}, - {"t":0.48351, "x":3.32449, "y":5.1102, "heading":2.8442, "vx":-0.64951, "vy":-0.94278, "omega":-4.10833, "ax":2.86424, "ay":5.33247, "alpha":21.72054, "fx":[134.35771,104.04724,9.50307,-66.02065], "fy":[2.6724,85.36354,134.20037,116.39108]}, - {"t":0.51037, "x":3.30808, "y":5.0868, "heading":2.73384, "vx":-0.57257, "vy":-0.79954, "omega":-3.52489, "ax":3.12292, "ay":5.1933, "alpha":21.93031, "fx":[134.3859,108.3811,16.93474,-61.38721], "fy":[-2.81811,79.8486,133.52206,119.23693]}, - {"t":0.53723, "x":3.29383, "y":5.0672, "heading":2.63916, "vx":-0.48869, "vy":-0.66004, "omega":-2.93581, "ax":3.34543, "ay":5.07332, "alpha":21.98891, "fx":[134.24914,111.8157,23.22655,-56.84681], "fy":[-7.11209,75.01069,132.61243,121.65955]}, - {"t":0.56409, "x":3.28191, "y":5.0513, "heading":2.5603, "vx":-0.39882, "vy":-0.52377, "omega":-2.34516, "ax":3.52966, "ay":4.97336, "alpha":21.95475, "fx":[134.05785,114.47888,28.39716,-52.79005], "fy":[-10.32264,70.91898,131.63211,123.5942]}, - {"t":0.59095, "x":3.27247, "y":5.03903, "heading":2.49731, "vx":-0.30401, "vy":-0.39018, "omega":-1.75542, "ax":3.67579, "ay":4.89397, "alpha":21.87268, "fx":[133.87855,116.48081,32.47872,-49.41439], "fy":[-12.6029,67.61423,130.70807,125.06218]}, - {"t":0.61781, "x":3.26563, "y":5.03031, "heading":2.45015, "vx":-0.20527, "vy":-0.25872, "omega":-1.16789, "ax":3.78469, "ay":4.83515, "alpha":21.77847, "fx":[133.74344,117.91019,35.50681,-46.82122], "fy":[-14.12099,65.11915,129.93656,126.11163]}, - {"t":0.64467, "x":3.26148, "y":5.02511, "heading":2.41878, "vx":-0.10361, "vy":-0.12884, "omega":-0.58289, "ax":3.85728, "ay":4.79643, "alpha":21.69985, "fx":[133.66238,118.83323,37.51474,-45.06181], "fy":[-15.03519,63.4456,129.38601,126.79078]}, - {"t":0.67154, "x":3.26009, "y":5.02338, "heading":2.40312, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":3.59926, "y":5.61458, "heading":-1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.34442, "ay":-0.05626, "alpha":-36.4657, "fx":[-92.6474,81.64727,83.75243,-94.62423], "fy":[-97.6298,-106.9668,105.31691,95.70697]}, + {"t":0.0205, "x":3.59918, "y":5.61457, "heading":-1.5708, "vx":-0.00706, "vy":-0.00115, "omega":-0.74767, "ax":-0.38319, "ay":-0.0625, "alpha":-36.43809, "fx":[-93.03322,80.7875,83.13315,-95.22123], "fy":[-97.19476,-107.54652,105.73078,95.04158]}, + {"t":0.04101, "x":3.59896, "y":5.61453, "heading":-1.58613, "vx":-0.01492, "vy":-0.00243, "omega":-1.49477, "ax":-0.43936, "ay":-0.06988, "alpha":-36.39543, "fx":[-94.94664,77.77898,83.95778,-94.69059], "fy":[-95.22777,-109.6399,104.96339,95.46676]}, + {"t":0.06151, "x":3.59856, "y":5.61447, "heading":-1.61677, "vx":-0.02393, "vy":-0.00387, "omega":-2.24099, "ax":-0.52871, "ay":-0.07971, "alpha":-36.32132, "fx":[-98.3589,72.08946,85.99083,-93.29608], "fy":[-91.5393,-113.30337,103.11314,96.66774]}, + {"t":0.08201, "x":3.59796, "y":5.61437, "heading":-1.66272, "vx":-0.03477, "vy":-0.0055, "omega":-2.9857, "ax":-0.69471, "ay":-0.095, "alpha":-36.16399, "fx":[-103.2403,62.29143,88.58434,-91.7519], "fy":[-85.69404,-118.68984,100.5089,97.84203]}, + {"t":0.10252, "x":3.5971, "y":5.61424, "heading":-1.72394, "vx":-0.04901, "vy":-0.00745, "omega":-3.72718, "ax":-1.11376, "ay":-0.12118, "alpha":-35.65624, "fx":[-109.7206,42.83412,89.01005,-92.85037], "fy":[-76.45996,-126.35174,99.02557,96.09074]}, + {"t":0.12302, "x":3.59586, "y":5.61406, "heading":-1.80036, "vx":-0.07185, "vy":-0.00993, "omega":-4.45825, "ax":-4.56757, "ay":0.0485, "alpha":-26.24409, "fx":[-119.40421,-43.48977,-10.94483,-116.21536], "fy":[-55.76173,-122.45099,120.65896,60.63382]}, + {"t":0.14352, "x":3.59343, "y":5.61387, "heading":-1.89177, "vx":-0.1655, "vy":-0.00894, "omega":-4.99634, "ax":-7.56286, "ay":-1.65065, "alpha":-0.05629, "fx":[-120.18493,-119.87298,-120.1634,-120.04251], "fy":[-25.78765,-27.06229,-25.63202,-26.33941]}, + {"t":0.16403, "x":3.58845, "y":5.61334, "heading":-1.99421, "vx":-0.32056, "vy":-0.04278, "omega":-4.99749, "ax":-7.49063, "ay":-1.72193, "alpha":-0.00004, "fx":[-118.9197,-118.91731,-118.92455,-118.91542], "fy":[-27.33692,-27.34613,-27.31454,-27.35001]}, + {"t":0.18453, "x":3.5803, "y":5.6121, "heading":-2.09667, "vx":-0.47414, "vy":-0.07809, "omega":-4.99749, "ax":-7.43269, "ay":-1.62897, "alpha":0.0, "fx":[-117.99499,-118.00329,-117.99619,-118.00302], "fy":[-25.88335,-25.84267,-25.87381,-25.84464]}, + {"t":0.20503, "x":3.56901, "y":5.61015, "heading":-2.19914, "vx":-0.62654, "vy":-0.11149, "omega":-4.99749, "ax":-7.30279, "ay":-1.7264, "alpha":0.0, "fx":[-115.96369,-115.92423,-115.93836,-115.9224], "fy":[-27.29869,-27.46419,-27.40284,-27.46553]}, + {"t":0.22554, "x":3.55463, "y":5.60751, "heading":-2.3016, "vx":-0.77627, "vy":-0.14689, "omega":-4.99749, "ax":-7.18344, "ay":-1.51667, "alpha":0.0, "fx":[-114.03885,-114.04986,-114.03232,-114.04859], "fy":[-24.10677,-24.04202,-24.11693,-24.04722]}, + {"t":0.24604, "x":3.53721, "y":5.60418, "heading":-2.40407, "vx":-0.92355, "vy":-0.17798, "omega":-4.99749, "ax":-6.77043, "ay":-1.6881, "alpha":0.00002, "fx":[-107.63902,-107.53247,-107.50247,-107.26817], "fy":[-26.49795,-26.86924,-26.80058,-27.03157]}, + {"t":0.26654, "x":3.51685, "y":5.60017, "heading":-2.50653, "vx":-1.06237, "vy":-0.21259, "omega":-4.99749, "ax":-6.54015, "ay":-1.24247, "alpha":0.00001, "fx":[-103.84435,-103.84676,-103.79986,-103.82787], "fy":[-19.75194,-19.64963,-19.7956,-19.70304]}, + {"t":0.28705, "x":3.49369, "y":5.59555, "heading":-2.609, "vx":-1.19646, "vy":-0.23807, "omega":-4.99749, "ax":-3.50731, "ay":-1.01821, "alpha":-0.00002, "fx":[-55.87589,-55.92901,-56.03683,-54.88299], "fy":[-15.9895,-16.12626,-16.19683,-16.34643]}, + {"t":0.30755, "x":3.46842, "y":5.59046, "heading":-2.71146, "vx":-1.26837, "vy":-0.25894, "omega":-4.99749, "ax":-1.99064, "ay":-0.4822, "alpha":0.00001, "fx":[-31.62103,-31.61132,-31.58441,-31.59476], "fy":[-7.66823,-7.61479,-7.67508,-7.66299]}, + {"t":0.32805, "x":3.442, "y":5.58505, "heading":-2.81393, "vx":-1.30919, "vy":-0.26883, "omega":-4.99749, "ax":1.43022, "ay":0.07673, "alpha":0.00001, "fx":[22.73855,22.76469,22.85197,22.46766], "fy":[1.10856,1.20839,1.23888,1.31643]}, + {"t":0.34856, "x":3.41546, "y":5.57955, "heading":-2.91639, "vx":-1.27986, "vy":-0.26726, "omega":-4.99749, "ax":5.54892, "ay":0.58548, "alpha":-0.00002, "fx":[88.13301,88.12692,88.0488,88.06427], "fy":[9.32913,9.15875,9.37106,9.32078]}, + {"t":0.36906, "x":3.39038, "y":5.57419, "heading":-3.01886, "vx":-1.16609, "vy":-0.25525, "omega":-4.99749, "ax":5.80813, "ay":1.08324, "alpha":0.00002, "fx":[92.32633,92.33653,92.5593,91.61143], "fy":[16.92427,17.10423,17.11956,17.64079]}, + {"t":0.38956, "x":3.36769, "y":5.56919, "heading":-3.12132, "vx":-1.04701, "vy":-0.23304, "omega":-4.99749, "ax":7.00953, "ay":1.16269, "alpha":-0.00002, "fx":[111.28431,111.30386,111.26311,111.27424], "fy":[18.46403,18.33906,18.55143,18.47956]}, + {"t":0.41007, "x":3.3477, "y":5.56465, "heading":3.0594, "vx":-0.90329, "vy":-0.2092, "omega":-4.99749, "ax":7.20749, "ay":1.4647, "alpha":0.0, "fx":[114.46442,114.43149,114.4364,114.36461], "fy":[23.06791,23.24015,23.19165,23.51312]}, + {"t":0.43057, "x":3.3307, "y":5.56067, "heading":2.95694, "vx":-0.75551, "vy":-0.17917, "omega":-4.99749, "ax":7.37111, "ay":1.41858, "alpha":0.0, "fx":[117.02034,117.03923,117.01143,117.01626], "fy":[22.53051,22.43008,22.57491,22.54846]}, + {"t":0.45107, "x":3.31675, "y":5.5573, "heading":2.85447, "vx":-0.60438, "vy":-0.15009, "omega":-4.99749, "ax":7.45306, "ay":1.55773, "alpha":0.0, "fx":[118.3395,118.32031,118.33434,118.29694], "fy":[24.65061,24.7418,24.67656,24.85176]}, + {"t":0.47158, "x":3.30593, "y":5.55455, "heading":2.75201, "vx":-0.45157, "vy":-0.11815, "omega":-4.99749, "ax":7.53299, "ay":1.53648, "alpha":0.00005, "fx":[119.59028,119.59668,119.58937,119.59082], "fy":[24.40015,24.36842,24.4048,24.39762]}, + {"t":0.49208, "x":3.29825, "y":5.55245, "heading":2.64954, "vx":-0.29712, "vy":-0.08665, "omega":-4.99749, "ax":7.57451, "ay":1.60768, "alpha":0.05123, "fx":[120.37774,120.22862,120.22499,120.17222], "fy":[24.94361,25.77385,25.62793,25.74705]}, + {"t":0.51258, "x":3.29375, "y":5.55101, "heading":2.54708, "vx":-0.14182, "vy":-0.05368, "omega":-4.99644, "ax":3.69354, "ay":1.5511, "alpha":26.20797, "fx":[108.65028,130.12186,65.65659,-69.87805], "fy":[-72.50039,20.63803,112.59392,37.76752]}, + {"t":0.53308, "x":3.29162, "y":5.55023, "heading":2.44463, "vx":-0.06609, "vy":-0.02188, "omega":-4.45909, "ax":0.98596, "ay":0.35249, "alpha":35.68542, "fx":[51.47846,133.52372,10.56388,-132.95467], "fy":[-123.17043,7.56254,133.10572,4.88616]}, + {"t":0.55359, "x":3.29047, "y":5.54986, "heading":2.35321, "vx":-0.04587, "vy":-0.01465, "omega":-3.72742, "ax":0.63465, "ay":0.21596, "alpha":36.17114, "fx":[28.53821,134.0933,10.69039,-133.02001], "fy":[-130.99592,-4.68303,133.67314,15.71969]}, + {"t":0.57409, "x":3.28967, "y":5.5496, "heading":2.27678, "vx":-0.03286, "vy":-0.01023, "omega":-2.9858, "ax":0.4923, "ay":0.16031, "alpha":36.32407, "fx":[13.51653,133.53191,16.0409,-131.82676], "fy":[-133.62255,-14.95956,133.36927,25.39274]}, + {"t":0.59459, "x":3.2891, "y":5.54943, "heading":2.21556, "vx":-0.02276, "vy":-0.00694, "omega":-2.24103, "ax":0.41451, "ay":0.12979, "alpha":36.39674, "fx":[2.55777,132.46011,21.56035,-130.25573], "fy":[-134.40837,-23.19346,132.7141,33.12991]}, + {"t":0.6151, "x":3.28872, "y":5.54931, "heading":2.16961, "vx":-0.01427, "vy":-0.00428, "omega":-1.49478, "ax":0.36513, "ay":0.11073, "alpha":36.43869, "fx":[-5.36302,131.29602,26.01981,-128.76597], "fy":[-134.40636,-29.38765,131.99062,38.83485]}, + {"t":0.6356, "x":3.2885, "y":5.54925, "heading":2.13897, "vx":-0.00678, "vy":-0.00201, "omega":-0.74767, "ax":0.33062, "ay":0.09795, "alpha":36.46587, "fx":[-10.65946,130.33817,28.9794,-127.66282], "fy":[-134.14586,-33.57454,131.42616,42.51439]}, + {"t":0.6561, "x":3.28843, "y":5.54923, "heading":2.12364, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[] diff --git a/src/main/deploy/choreo/LeftShootToBump.traj b/src/main/deploy/choreo/LeftShootToBump.traj index adc3e54e..e43bddbf 100644 --- a/src/main/deploy/choreo/LeftShootToBump.traj +++ b/src/main/deploy/choreo/LeftShootToBump.traj @@ -3,26 +3,28 @@ "version":3, "snapshot":{ "waypoints":[ - {"x":3.260087728500366, "y":5.023375511169434, "heading":2.4031239516930234, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.2884325981140137, "y":5.549228191375732, "heading":2.1236372236423873, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.60064959526062, "y":5.671574592590332, "heading":-1.57, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":5.0}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":7.0}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":5.5}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"3.260087728500366 m", "val":3.260087728500366}, "y":{"exp":"5.023375511169434 m", "val":5.023375511169434}, "heading":{"exp":"2.4031239516930234 rad", "val":2.4031239516930234}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.2884325981140137 m", "val":3.2884325981140137}, "y":{"exp":"5.549228191375732 m", "val":5.549228191375732}, "heading":{"exp":"2.1236372236423873 rad", "val":2.1236372236423873}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"3.60064959526062 m", "val":3.60064959526062}, "y":{"exp":"5.671574592590332 m", "val":5.671574592590332}, "heading":{"exp":"-3.14 / 2 rad", "val":-1.57}, "intervals":19, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":{"exp":"5 m / s", "val":5.0}}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"8 m / s ^ 2", "val":8.0}}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"7 m / s ^ 2", "val":7.0}}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"5.5 rad / s", "val":5.5}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -53,35 +55,40 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,0.68326], + "waypoints":[0.0,0.63042], "samples":[ - {"t":0.0, "x":3.26009, "y":5.02338, "heading":2.40312, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.56334, "ay":5.19149, "alpha":20.82833, "fx":[134.38465,114.04489,29.89873,-52.04558], "fy":[2.5416,71.66903,131.35107,124.11295]}, - {"t":0.02628, "x":3.26132, "y":5.02517, "heading":2.40312, "vx":0.09364, "vy":0.13643, "omega":0.54736, "ax":3.57074, "ay":5.21225, "alpha":20.71229, "fx":[134.32181,113.92523,30.01021,-51.50471], "fy":[3.53983,71.83062,131.31155,124.31117]}, - {"t":0.05256, "x":3.26501, "y":5.03055, "heading":2.41751, "vx":0.18748, "vy":0.2734, "omega":1.09166, "ax":3.5414, "ay":5.23389, "alpha":20.71905, "fx":[134.26547,113.39937,29.17166,-51.94699], "fy":[4.16928,72.62551,131.48296,124.08972]}, - {"t":0.07884, "x":3.27116, "y":5.03955, "heading":2.4462, "vx":0.28055, "vy":0.41095, "omega":1.63615, "ax":3.47953, "ay":5.2658, "alpha":20.78968, "fx":[134.20448,112.41509,27.44626,-53.10573], "fy":[4.91126,74.1029,131.83231,123.54754]}, - {"t":0.10512, "x":3.27974, "y":5.05216, "heading":2.48919, "vx":0.37198, "vy":0.54933, "omega":2.18249, "ax":3.38532, "ay":5.31012, "alpha":20.89875, "fx":[134.12702,110.93707,24.8309,-54.91729], "fy":[5.94849,76.25465,132.32239,122.68256]}, - {"t":0.1314, "x":3.29068, "y":5.06843, "heading":2.54655, "vx":0.46095, "vy":0.68888, "omega":2.73169, "ax":3.25896, "ay":5.36942, "alpha":21.01082, "fx":[134.00968,108.91223,21.31713,-57.28558], "fy":[7.51449,79.0678,132.8978,121.49362]}, - {"t":0.15768, "x":3.30392, "y":5.08839, "heading":2.61833, "vx":0.54659, "vy":0.82998, "omega":3.28384, "ax":3.10113, "ay":5.44635, "alpha":21.08013, "fx":[133.81036,106.26527,16.90245,-60.04753], "fy":[9.85039,82.52605,133.48227,120.00058]}, - {"t":0.18396, "x":3.31935, "y":5.11208, "heading":2.70463, "vx":0.62809, "vy":0.97311, "omega":3.83782, "ax":2.91377, "ay":5.54309, "alpha":21.0504, "fx":[133.45818,102.9107,11.5907,-62.92687], "fy":[13.16371,86.58737,133.9781,118.2731]}, - {"t":0.21024, "x":3.33687, "y":5.13957, "heading":2.80549, "vx":0.70466, "vy":1.11878, "omega":4.39101, "ax":2.70201, "ay":5.66212, "alpha":20.84521, "fx":[132.84014,98.73799,5.41779,-65.4102], "fy":[17.60934,91.19515,134.2618,116.49524]}, - {"t":0.23651, "x":3.35632, "y":5.17092, "heading":2.92088, "vx":0.77567, "vy":1.26757, "omega":4.93881, "ax":2.47915, "ay":5.80746, "alpha":20.34704, "fx":[131.7788,93.63119,-1.53677,-66.43978], "fy":[23.29252,96.23844,134.17809,115.08159]}, - {"t":0.26279, "x":3.37756, "y":5.20624, "heading":3.05067, "vx":0.84082, "vy":1.42019, "omega":5.47351, "ax":2.28362, "ay":5.98699, "alpha":19.32802, "fx":[129.9669,87.43281,-9.06988,-63.31297], "fy":[30.27635,101.53773,133.50201,114.87502]}, - {"t":0.28907, "x":3.40044, "y":5.24563, "heading":-3.08868, "vx":0.90083, "vy":1.57752, "omega":5.98144, "ax":2.24058, "ay":6.18854, "alpha":17.272, "fx":[126.49288,79.73748,-16.62573,-47.32112], "fy":[38.79643,106.66112,131.62561,115.90729]}, - {"t":0.31535, "x":3.42489, "y":5.28922, "heading":-2.93149, "vx":0.95971, "vy":1.74015, "omega":6.43534, "ax":1.23733, "ay":4.68099, "alpha":5.01288, "fx":[42.57885,29.7975,1.435,4.76256], "fy":[65.54384,82.91315,83.57978,65.21956]}, - {"t":0.34163, "x":3.45054, "y":5.33657, "heading":-2.76237, "vx":0.99223, "vy":1.86317, "omega":6.56707, "ax":-3.64036, "ay":-4.32865, "alpha":-19.60605, "fx":[-123.53043,-63.9892,42.04994,-85.70415], "fy":[-47.96638,-116.6512,-125.1536,14.88938]}, - {"t":0.36791, "x":3.47535, "y":5.38404, "heading":-2.58979, "vx":0.89656, "vy":1.74941, "omega":6.05184, "ax":-3.96682, "ay":-4.81844, "alpha":-18.51182, "fx":[-118.92307,-54.15645,48.77796,-127.60292], "fy":[-61.27939,-122.53585,-124.07362,1.90366]}, - {"t":0.39419, "x":3.49755, "y":5.42835, "heading":-2.43075, "vx":0.79232, "vy":1.62279, "omega":5.56536, "ax":-3.71061, "ay":-4.93584, "alpha":-19.54214, "fx":[-114.03359,-44.98166,55.15482,-131.77393], "fy":[-70.7204,-126.50553,-121.80138,5.58705]}, - {"t":0.42047, "x":3.51709, "y":5.46929, "heading":-2.2845, "vx":0.6948, "vy":1.49308, "omega":5.05181, "ax":-3.43165, "ay":-5.09696, "alpha":-20.0693, "fx":[-108.90148,-36.37862,60.52203,-133.16172], "fy":[-78.71923,-129.39115,-119.41457,3.85323]}, - {"t":0.44675, "x":3.53416, "y":5.50677, "heading":-2.15174, "vx":0.60462, "vy":1.35913, "omega":4.5244, "ax":-3.1726, "ay":-5.26433, "alpha":-20.23614, "fx":[-103.81409,-28.46067,64.60156,-133.79636], "fy":[-85.4891,-131.4461,-117.34652,-0.0187]}, - {"t":0.47303, "x":3.54895, "y":5.54067, "heading":-2.03284, "vx":0.52125, "vy":1.22079, "omega":3.9926, "ax":-2.94377, "ay":-5.42315, "alpha":-20.15363, "fx":[-98.93481,-21.29568,67.31825,-134.02596], "fy":[-91.19549,-132.85119,-115.84292,-4.49625]}, - {"t":0.49931, "x":3.56164, "y":5.57087, "heading":-1.92792, "vx":0.44389, "vy":1.07827, "omega":3.46298, "ax":-2.7495, "ay":-5.56873, "alpha":-19.89673, "fx":[-94.39381,-14.9085,68.68933,-133.98813], "fy":[-95.95646,-133.75808,-115.03287,-8.88328]}, - {"t":0.52559, "x":3.57235, "y":5.59729, "heading":-1.83691, "vx":0.37163, "vy":0.93193, "omega":2.94011, "ax":-2.59131, "ay":-5.69946, "alpha":-19.52599, "fx":[-90.29049,-9.29585,68.81522,-133.78471], "fy":[-99.87513,-134.2945,-114.92974,-12.83289]}, - {"t":0.55187, "x":3.58122, "y":5.61981, "heading":-1.75965, "vx":0.30353, "vy":0.78215, "omega":2.42697, "ax":-2.46816, "ay":-5.81421, "alpha":-19.09688, "fx":[-86.6915,-4.434,67.89229,-133.50244], "fy":[-103.04996,-134.56611,-115.43133,-16.17227]}, - {"t":0.57815, "x":3.58835, "y":5.63836, "heading":-1.69587, "vx":0.23867, "vy":0.62936, "omega":1.92512, "ax":-2.37538, "ay":-5.91018, "alpha":-18.67094, "fx":[-83.64784,-0.29546,66.31426,-133.21462], "fy":[-105.56276,-134.658,-116.28793,-18.80506]}, - {"t":0.60443, "x":3.5938, "y":5.65286, "heading":-1.64528, "vx":0.17625, "vy":0.47404, "omega":1.43446, "ax":-2.30382, "ay":-5.98291, "alpha":-18.31693, "fx":[-81.18941,3.14766,64.72052,-132.97828], "fy":[-107.48671,-134.63789,-117.12245,-20.68544]}, - {"t":0.63071, "x":3.59763, "y":5.66325, "heading":-1.60758, "vx":0.11571, "vy":0.31681, "omega":0.9531, "ax":-2.23912, "ay":-6.02568, "alpha":-18.11545, "fx":[-79.34043,5.91693,64.0681,-132.83509], "fy":[-108.87639,-134.55902,-117.42835,-21.78481]}, - {"t":0.65698, "x":3.5999, "y":5.66949, "heading":-1.58254, "vx":0.05686, "vy":0.15846, "omega":0.47704, "ax":-2.16378, "ay":-6.02996, "alpha":-18.15262, "fx":[-78.11681,8.02508,65.49728,-132.81181], "fy":[-109.77248,-134.46271,-116.60661,-22.07825]}, - {"t":0.68326, "x":3.60065, "y":5.67157, "heading":-1.57, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":3.28843, "y":5.54923, "heading":2.12364, "vx":0.0, "vy":0.0, "omega":0.0, "ax":1.37256, "ay":0.62734, "alpha":35.51726, "fx":[18.24928,133.08119,51.25657,-115.42541], "fy":[-133.29412,-20.37651,124.47765,69.03089]}, + {"t":0.02034, "x":3.28872, "y":5.54936, "heading":2.12364, "vx":0.02791, "vy":0.01276, "omega":0.72228, "ax":1.46576, "ay":0.67508, "alpha":35.36581, "fx":[21.1208,133.19936,52.75115,-113.99104], "fy":[-132.82166,-19.39086,123.81778,71.26439]}, + {"t":0.04067, "x":3.28959, "y":5.54976, "heading":2.13833, "vx":0.05772, "vy":0.02649, "omega":1.44149, "ax":1.5799, "ay":0.74569, "alpha":35.15785, "fx":[26.95089,133.53274,53.1958,-113.35137], "fy":[-131.70086,-16.65179,123.58245,72.12341]}, + {"t":0.06101, "x":3.29109, "y":5.55045, "heading":2.16764, "vx":0.08985, "vy":0.04165, "omega":2.15646, "ax":1.72947, "ay":0.85325, "alpha":34.84895, "fx":[36.14111,133.97181,52.94654,-113.23318], "fy":[-129.39752,-12.12247,123.62776,72.07599]}, + {"t":0.08134, "x":3.29327, "y":5.55147, "heading":2.21149, "vx":0.12502, "vy":0.059, "omega":2.86515, "ax":1.93895, "ay":1.02439, "alpha":34.34731, "fx":[49.21999,134.32921,52.59929,-113.01918], "fy":[-124.88849,-5.77019,123.68674,72.02368]}, + {"t":0.10168, "x":3.29622, "y":5.55288, "heading":2.26976, "vx":0.16445, "vy":0.07983, "omega":3.56364, "ax":2.26652, "ay":1.32429, "alpha":33.40253, "fx":[67.05304,134.33297,53.42095,-110.87647], "fy":[-116.09757,2.44878,123.19481,74.55033]}, + {"t":0.12202, "x":3.30003, "y":5.55478, "heading":2.34223, "vx":0.21054, "vy":0.10677, "omega":4.24292, "ax":2.91879, "ay":1.96583, "alpha":30.99816, "fx":[90.8474,133.59932,58.39294,-97.48824], "fy":[-98.22819,12.6235,120.6715,89.76904]}, + {"t":0.14235, "x":3.30491, "y":5.55736, "heading":2.42852, "vx":0.2699, "vy":0.14674, "omega":4.8733, "ax":5.45609, "ay":3.18413, "alpha":19.3691, "fx":[118.75714,131.61858,74.73727,21.36491], "fy":[-60.57006,24.40984,110.73174,127.63019]}, + {"t":0.16269, "x":3.31153, "y":5.561, "heading":2.52762, "vx":0.38086, "vy":0.2115, "omega":5.2672, "ax":6.52541, "ay":2.42404, "alpha":11.26794, "fx":[120.06934,124.32743,83.20918,86.77652], "fy":[-33.74954,28.78305,93.67489,65.22533]}, + {"t":0.18303, "x":3.32063, "y":5.5658, "heading":2.63473, "vx":0.51356, "vy":0.26079, "omega":5.49634, "ax":6.54924, "ay":2.35136, "alpha":0.02177, "fx":[104.03938,103.95316,103.92109,103.9823], "fy":[37.14713,37.33288,37.4813,37.35706]}, + {"t":0.20336, "x":3.33242, "y":5.57159, "heading":2.74651, "vx":0.64674, "vy":0.30861, "omega":5.49679, "ax":6.54793, "ay":2.3269, "alpha":0.0, "fx":[103.98833,103.93647,103.99003,103.89818], "fy":[36.84433,36.97136,36.84995,37.09919]}, + {"t":0.2237, "x":3.34693, "y":5.57835, "heading":2.85829, "vx":0.7799, "vy":0.35593, "omega":5.49679, "ax":6.54696, "ay":2.28455, "alpha":-0.00001, "fx":[103.93044,103.97272,103.92428,103.92383], "fy":[36.29239,36.16284,36.30952,36.31058]}, + {"t":0.24403, "x":3.36414, "y":5.58606, "heading":2.97007, "vx":0.91304, "vy":0.40239, "omega":5.49679, "ax":6.5406, "ay":2.21894, "alpha":0.0, "fx":[103.87363,103.84269,103.86511,103.76561], "fy":[35.11864,35.21258,35.16263,35.4154]}, + {"t":0.26437, "x":3.38406, "y":5.5947, "heading":3.08186, "vx":1.04605, "vy":0.44751, "omega":5.49679, "ax":6.54818, "ay":1.98243, "alpha":0.0, "fx":[103.95756,104.02191,103.91551,103.93365], "fy":[31.50383,31.25076,31.60519,31.5301]}, + {"t":0.28471, "x":3.40669, "y":5.60421, "heading":-3.08954, "vx":1.17922, "vy":0.48783, "omega":5.49679, "ax":6.28367, "ay":1.4482, "alpha":-0.00004, "fx":[99.93769,99.93438,100.16327,98.99626], "fy":[22.67953,22.84289,22.78901,23.6534]}, + {"t":0.30504, "x":3.43197, "y":5.61443, "heading":-2.97776, "vx":1.307, "vy":0.51728, "omega":5.49678, "ax":-1.0682, "ay":-1.37688, "alpha":0.00001, "fx":[-17.04833,-17.02911,-16.86625,-16.89033], "fy":[-21.94225,-21.49504,-22.08863,-21.90995]}, + {"t":0.32538, "x":3.45833, "y":5.62467, "heading":-2.86598, "vx":1.28528, "vy":0.48928, "omega":5.49679, "ax":-5.94593, "ay":-3.06467, "alpha":0.00003, "fx":[-94.64979,-94.51098,-94.52301,-93.90027], "fy":[-48.24893,-48.58006,-48.52866,-49.25776]}, + {"t":0.34571, "x":3.48324, "y":5.63399, "heading":-2.75419, "vx":1.16436, "vy":0.42695, "omega":5.49679, "ax":-6.31747, "ay":-2.68724, "alpha":0.0, "fx":[-100.29795,-100.34817,-100.24078,-100.29089], "fy":[-42.67574,-42.5326,-42.77967,-42.65955]}, + {"t":0.36605, "x":3.50561, "y":5.64211, "heading":-2.64241, "vx":1.03589, "vy":0.37231, "omega":5.49679, "ax":-6.38408, "ay":-2.65881, "alpha":0.00001, "fx":[-101.40696,-101.35993,-101.34186,-101.29879], "fy":[-42.10036,-42.20335,-42.21737,-42.32085]}, + {"t":0.38639, "x":3.52536, "y":5.64913, "heading":-2.53063, "vx":0.90606, "vy":0.31824, "omega":5.49679, "ax":-6.43007, "ay":-2.6075, "alpha":0.0, "fx":[-102.08323,-102.09176,-102.0696,-102.08383], "fy":[-41.39218,-41.37219,-41.42764,-41.39206]}, + {"t":0.40672, "x":3.54245, "y":5.65507, "heading":-2.41884, "vx":0.7753, "vy":0.26521, "omega":5.49679, "ax":-6.45445, "ay":-2.58235, "alpha":-0.00001, "fx":[-102.48344,-102.46109,-102.46273,-102.46929], "fy":[-40.93762,-41.00249,-41.02505,-41.02169]}, + {"t":0.42706, "x":3.55688, "y":5.65993, "heading":-2.30706, "vx":0.64404, "vy":0.21269, "omega":5.49679, "ax":-6.47056, "ay":-2.56499, "alpha":-0.03809, "fx":[-102.69932,-102.58305,-102.77188,-102.84515], "fy":[-40.69701,-41.07371,-40.67586,-40.43778]}, + {"t":0.44739, "x":3.56864, "y":5.66372, "heading":-2.19528, "vx":0.51246, "vy":0.16053, "omega":5.49601, "ax":-6.46278, "ay":-2.58214, "alpha":-11.98695, "fx":[-123.98788,-81.41526,-85.50593,-119.49621], "fy":[-38.89772,-99.7597,-68.5286,43.21226]}, + {"t":0.46773, "x":3.57773, "y":5.66645, "heading":-2.08351, "vx":0.38103, "vy":0.10802, "omega":5.25224, "ax":-6.02014, "ay":-2.79774, "alpha":-15.24513, "fx":[-125.58709,-66.30585,-71.49268,-118.91099], "fy":[-46.45771,-115.99355,-75.64639,60.43268]}, + {"t":0.48807, "x":3.58423, "y":5.66807, "heading":-1.9767, "vx":0.2586, "vy":0.05113, "omega":4.94222, "ax":-2.49776, "ay":-0.45106, "alpha":-32.87524, "fx":[-122.75193,-35.96345,107.88955,-107.78956], "fy":[-54.3105,-129.09187,75.22084,79.53772]}, + {"t":0.5084, "x":3.58897, "y":5.66902, "heading":-1.87619, "vx":0.20781, "vy":0.04195, "omega":4.27366, "ax":-2.12078, "ay":-0.35221, "alpha":-34.11077, "fx":[-118.7724,-10.70711,98.88194,-104.0779], "fy":[-62.85798,-133.77471,89.50764,84.75869]}, + {"t":0.52874, "x":3.59276, "y":5.6698, "heading":-1.78928, "vx":0.16468, "vy":0.03479, "omega":3.57998, "ax":-1.88398, "ay":-0.33664, "alpha":-34.70295, "fx":[-114.36521,8.94337,90.28108,-104.49774], "fy":[-70.73368,-134.02751,98.90475,84.47879]}, + {"t":0.54908, "x":3.59572, "y":5.67043, "heading":-1.71648, "vx":0.12637, "vy":0.02795, "omega":2.87426, "ax":-1.71767, "ay":-0.33926, "alpha":-35.05027, "fx":[-110.00414,24.38044,82.75042,-106.20351], "fy":[-77.44925,-132.18083,105.60925,82.47708]}, + {"t":0.56941, "x":3.59794, "y":5.67093, "heading":-1.65803, "vx":0.09143, "vy":0.02105, "omega":2.16147, "ax":-1.59234, "ay":-0.34421, "alpha":-35.27893, "fx":[-106.04107,36.32943,76.62926,-108.03569], "fy":[-82.8651,-129.4726,110.31055,80.16883]}, + {"t":0.58975, "x":3.59947, "y":5.67129, "heading":-1.61407, "vx":0.05905, "vy":0.01405, "omega":1.44403, "ax":-1.49257, "ay":-0.34644, "alpha":-35.44264, "fx":[-102.74504,45.27749,72.17205,-109.48732], "fy":[-86.97086,-126.67241,113.39,78.2531]}, + {"t":0.61008, "x":3.60036, "y":5.6715, "heading":-1.58471, "vx":0.0287, "vy":0.007, "omega":0.72327, "ax":-1.41125, "ay":-0.34426, "alpha":-35.56569, "fx":[-100.32455,51.54127,69.50438,-110.33971], "fy":[-89.79237,-124.29732,115.12206,77.10607]}, + {"t":0.63042, "x":3.60065, "y":5.67157, "heading":-1.57, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[] diff --git a/src/main/deploy/choreo/RightSecondDip.traj b/src/main/deploy/choreo/RightSecondDip.traj index 51b9328d..7388fb3b 100644 --- a/src/main/deploy/choreo/RightSecondDip.traj +++ b/src/main/deploy/choreo/RightSecondDip.traj @@ -5,20 +5,21 @@ "waypoints":[ {"x":5.607864856719971, "y":2.2545297145843506, "heading":1.5707963267948966, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":6.374622821807861, "y":1.920681953430176, "heading":0.0, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":7.616988658905029, "y":1.900594472885132, "heading":1.1780352886194658, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":7.415774345397949, "y":3.393817186355591, "heading":2.7446892183710663, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":6.060224533081055, "y":3.563260793685913, "heading":3.141592653589793, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":7.616988658905029, "y":1.900594472885132, "heading":1.1780352886194658, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":7.415774345397949, "y":3.393817186355591, "heading":2.7446892183710663, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.060224533081055, "y":3.563260793685913, "heading":3.141592653589793, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.796180248260498, "y":2.8797600269317627, "heading":2.2617395073648874, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":5.6100335121154785, "y":2.2714898586273193, "heading":1.5707963267948966, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":false}, - {"from":0, "to":5, "data":{"type":"MaxAcceleration", "props":{"max":3.75}}, "enabled":true}, - {"from":0, "to":5, "data":{"type":"MaxAngularVelocity", "props":{"max":4.0}}, "enabled":true}, + {"from":0, "to":6, "data":{"type":"MaxAcceleration", "props":{"max":4.0}}, "enabled":true}, + {"from":0, "to":6, "data":{"type":"MaxAngularVelocity", "props":{"max":4.0}}, "enabled":true}, {"from":4, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"first", "to":3, "data":{"type":"MaxVelocity", "props":{"max":2.0}}, "enabled":true}, {"from":3, "to":4, "data":{"type":"MaxVelocity", "props":{"max":1.0}}, "enabled":true}, - {"from":4, "to":5, "data":{"type":"MaxVelocity", "props":{"max":2.0}}, "enabled":true}, + {"from":4, "to":6, "data":{"type":"MaxVelocity", "props":{"max":2.0}}, "enabled":true}, {"from":3, "to":4, "data":{"type":"KeepInLane", "props":{"tolerance":0.01}}, "enabled":true}], "targetDt":0.05 }, @@ -26,20 +27,21 @@ "waypoints":[ {"x":{"exp":"5.607864856719971 m", "val":5.607864856719971}, "y":{"exp":"2.2545297145843506 m", "val":2.2545297145843506}, "heading":{"exp":"1.5707963267948966 rad", "val":1.5707963267948966}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"6.374622821807861 m", "val":6.374622821807861}, "y":{"exp":"1.9206819534301758 m", "val":1.920681953430176}, "heading":{"exp":"0 rad", "val":0.0}, "intervals":33, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"7.616988658905029 m", "val":7.616988658905029}, "y":{"exp":"1.9005944728851318 m", "val":1.900594472885132}, "heading":{"exp":"1.1780352886194658 rad", "val":1.1780352886194658}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"7.415774345397949 m", "val":7.415774345397949}, "y":{"exp":"3.393817186355591 m", "val":3.393817186355591}, "heading":{"exp":"2.7446892183710663 rad", "val":2.7446892183710663}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"6.060224533081055 m", "val":6.060224533081055}, "y":{"exp":"3.563260793685913 m", "val":3.563260793685913}, "heading":{"exp":"3.141592653589793 rad", "val":3.141592653589793}, "intervals":36, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"7.616988658905029 m", "val":7.616988658905029}, "y":{"exp":"1.9005944728851318 m", "val":1.900594472885132}, "heading":{"exp":"1.1780352886194658 rad", "val":1.1780352886194658}, "intervals":37, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"7.415774345397949 m", "val":7.415774345397949}, "y":{"exp":"3.393817186355591 m", "val":3.393817186355591}, "heading":{"exp":"2.7446892183710663 rad", "val":2.7446892183710663}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.060224533081055 m", "val":6.060224533081055}, "y":{"exp":"3.563260793685913 m", "val":3.563260793685913}, "heading":{"exp":"3.141592653589793 rad", "val":3.141592653589793}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.796180248260498 m", "val":5.796180248260498}, "y":{"exp":"2.8797600269317627 m", "val":2.8797600269317627}, "heading":{"exp":"2.2617395073648874 rad", "val":2.2617395073648874}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"5.6100335121154785 m", "val":5.6100335121154785}, "y":{"exp":"2.2714898586273193 m", "val":2.2714898586273193}, "heading":{"exp":"1.5707963267948966 rad", "val":1.5707963267948966}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":false}, - {"from":0, "to":5, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"3.75 m / s ^ 2", "val":3.75}}}, "enabled":true}, - {"from":0, "to":5, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"4 rad / s", "val":4.0}}}, "enabled":true}, + {"from":0, "to":6, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"4 m / s ^ 2", "val":4.0}}}, "enabled":true}, + {"from":0, "to":6, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"4 rad / s", "val":4.0}}}, "enabled":true}, {"from":4, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, {"from":"first", "to":3, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"2 m / s", "val":2.0}}}, "enabled":true}, {"from":3, "to":4, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"1 m / s", "val":1.0}}}, "enabled":true}, - {"from":4, "to":5, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"2 m / s", "val":2.0}}}, "enabled":true}, + {"from":4, "to":6, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"2 m / s", "val":2.0}}}, "enabled":true}, {"from":3, "to":4, "data":{"type":"KeepInLane", "props":{"tolerance":{"exp":"0.01 m", "val":0.01}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", @@ -71,189 +73,201 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,0.41861,1.12907,2.14378,3.51268,4.39233], + "waypoints":[0.0,0.4186,1.11724,2.10307,3.48652,4.04495,4.36393], "samples":[ - {"t":0.0, "x":5.60786, "y":2.25453, "heading":1.5708, "vx":1.83761, "vy":-0.77444, "omega":-3.74286, "ax":0.28472, "ay":-0.15173, "alpha":-3.56348, "fx":[13.2589,-4.18369,-4.18225,13.18759], "fy":[7.61437,7.23464,-12.30237,-12.18165]}, - {"t":0.0135, "x":5.6327, "y":2.24406, "heading":1.52025, "vx":1.84145, "vy":-0.77649, "omega":-3.79097, "ax":-0.02005, "ay":-0.05178, "alpha":-1.7126, "fx":[4.10713,-4.24669,-4.73812,3.60427], "fy":[3.75929,4.0446,-5.3454,-5.7464]}, - {"t":0.02701, "x":5.65757, "y":2.23357, "heading":1.46906, "vx":1.84118, "vy":-0.77718, "omega":-3.8141, "ax":0.00488, "ay":0.01157, "alpha":-0.73497, "fx":[1.98975,-1.52307,-1.94326,1.78643], "fy":[1.97669,2.39064,-1.63507,-1.99733]}, - {"t":0.04051, "x":5.68243, "y":2.22307, "heading":1.41756, "vx":1.84125, "vy":-0.77703, "omega":-3.82403, "ax":-0.00288, "ay":-0.00667, "alpha":-0.27521, "fx":[0.77032,-0.60486,-0.86166,0.51346], "fy":[0.51341,0.73043,-0.73085,-0.93665]}, - {"t":0.05401, "x":5.70729, "y":2.21258, "heading":1.36592, "vx":1.84121, "vy":-0.77712, "omega":-3.82774, "ax":0.00733, "ay":0.01712, "alpha":-0.0799, "fx":[0.31616,-0.04904,-0.15317,0.35182], "fy":[0.39199,0.54138,0.12228,0.03181]}, - {"t":0.06752, "x":5.73216, "y":2.20209, "heading":1.31423, "vx":1.84131, "vy":-0.77689, "omega":-3.82882, "ax":0.0051, "ay":0.01245, "alpha":-0.02265, "fx":[0.25392,0.00826,-0.09196,0.15389], "fy":[0.21907,0.16749,0.21514,0.18918]}, - {"t":0.08102, "x":5.75702, "y":2.1916, "heading":1.26253, "vx":1.84138, "vy":-0.77672, "omega":-3.82913, "ax":0.00923, "ay":0.02149, "alpha":0.00838, "fx":[0.13055,0.16178,0.14539,0.14868], "fy":[0.22839,0.35999,0.39524,0.3809]}, - {"t":0.09452, "x":5.78189, "y":2.18111, "heading":1.21083, "vx":1.8415, "vy":-0.77643, "omega":-3.82901, "ax":0.00776, "ay":0.01886, "alpha":-0.00652, "fx":[0.32443,0.07472,-0.07808,0.17167], "fy":[0.30719,0.11488,0.38989,0.38547]}, - {"t":0.10803, "x":5.80676, "y":2.17063, "heading":1.15912, "vx":1.84161, "vy":-0.77617, "omega":-3.8291, "ax":0.01134, "ay":0.02644, "alpha":0.00805, "fx":[0.17647,0.20554,0.17758,0.16029], "fy":[0.26592,0.45718,0.49033,0.4658]}, - {"t":0.12153, "x":5.83163, "y":2.16015, "heading":1.10741, "vx":1.84176, "vy":-0.77582, "omega":-3.82899, "ax":0.00985, "ay":0.02384, "alpha":-0.01283, "fx":[0.45819,0.12033,-0.14543,0.19225], "fy":[0.41112,0.11922,0.49837,0.48531]}, - {"t":0.13503, "x":5.8565, "y":2.14968, "heading":1.05571, "vx":1.84189, "vy":-0.77549, "omega":-3.82917, "ax":0.01316, "ay":0.03085, "alpha":0.00668, "fx":[0.20677,0.24119,0.20043,0.18724], "fy":[0.3054,0.53668,0.57615,0.54067]}, - {"t":0.14854, "x":5.88137, "y":2.13921, "heading":1.004, "vx":1.84207, "vy":-0.77508, "omega":-3.82908, "ax":0.01103, "ay":0.02659, "alpha":-0.01424, "fx":[0.56497,0.17844,-0.2145,0.17162], "fy":[0.46829,0.06381,0.58163,0.57465]}, - {"t":0.16204, "x":5.90624, "y":2.12875, "heading":0.9523, "vx":1.84222, "vy":-0.77472, "omega":-3.82927, "ax":0.01338, "ay":0.03157, "alpha":0.01118, "fx":[0.18105,0.25097,0.21734,0.2002], "fy":[0.29164,0.52721,0.60731,0.57869]}, - {"t":0.17554, "x":5.93112, "y":2.11829, "heading":0.90059, "vx":1.8424, "vy":-0.77429, "omega":-3.82912, "ax":0.00952, "ay":0.02278, "alpha":-0.01195, "fx":[0.61872,0.21473,-0.31631,0.08711], "fy":[0.42048,-0.12499,0.56399,0.58705]}, - {"t":0.18905, "x":5.956, "y":2.10783, "heading":0.84888, "vx":1.84253, "vy":-0.77399, "omega":-3.82928, "ax":0.00951, "ay":0.02271, "alpha":0.0207, "fx":[0.06355,0.18616,0.18508,0.16928], "fy":[0.14521,0.33855,0.47861,0.4797]}, - {"t":0.20255, "x":5.98088, "y":2.09738, "heading":0.79717, "vx":1.84266, "vy":-0.77368, "omega":-3.829, "ax":0.00188, "ay":0.00422, "alpha":-0.00821, "fx":[0.57,0.17035,-0.51018,-0.11086], "fy":[0.14816,-0.57265,0.30474,0.3879]}, - {"t":0.21606, "x":6.00577, "y":2.08694, "heading":0.74547, "vx":1.84268, "vy":-0.77362, "omega":-3.82911, "ax":-0.00271, "ay":-0.00593, "alpha":0.03354, "fx":[-0.2052,-0.03065,0.02428,0.03963], "fy":[-0.27574,-0.18346,0.01522,0.06747]}, - {"t":0.22956, "x":6.03065, "y":2.07649, "heading":0.69376, "vx":1.84265, "vy":-0.7737, "omega":-3.82866, "ax":-0.01773, "ay":-0.04298, "alpha":-0.00958, "fx":[0.34839,-0.04848,-0.91182,-0.5137], "fy":[-0.55801,-1.47717,-0.42767,-0.2665]}, - {"t":0.24306, "x":6.05553, "y":2.06604, "heading":0.64206, "vx":1.84241, "vy":-0.77428, "omega":-3.82879, "ax":-0.03035, "ay":-0.07108, "alpha":0.0411, "fx":[-0.70047,-0.51517,-0.42167,-0.2901], "fy":[-1.2124,-1.27002,-1.06015,-0.97109]}, - {"t":0.25657, "x":6.0804, "y":2.05558, "heading":0.59036, "vx":1.842, "vy":-0.77524, "omega":-3.82823, "ax":-0.059, "ay":-0.14136, "alpha":-0.02795, "fx":[-0.15185,-0.58278,-1.72461,-1.28729], "fy":[-2.04883,-3.16199,-1.98988,-1.77635]}, - {"t":0.27007, "x":6.10527, "y":2.04509, "heading":0.53867, "vx":1.8412, "vy":-0.77715, "omega":-3.82861, "ax":-0.08492, "ay":-0.19916, "alpha":0.05035, "fx":[-1.62218,-1.46017,-1.33543,-0.97518], "fy":[-3.04609,-3.36205,-3.1785,-3.06076]}, - {"t":0.28357, "x":6.13013, "y":2.03458, "heading":0.48697, "vx":1.84005, "vy":-0.77984, "omega":-3.82793, "ax":-0.13791, "ay":-0.32617, "alpha":0.00047, "fx":[-1.4055,-1.7528,-2.98281,-2.61667], "fy":[-4.82323,-6.4229,-4.98615,-4.48042]}, - {"t":0.29708, "x":6.15496, "y":2.02402, "heading":0.43528, "vx":1.83819, "vy":-0.78424, "omega":-3.82792, "ax":-0.18512, "ay":-0.4302, "alpha":0.30307, "fx":[-4.10958,-3.52732,-2.19938,-1.91948], "fy":[-6.10569,-7.89952,-7.23641,-6.07755]}, - {"t":0.31058, "x":6.17977, "y":2.01339, "heading":0.38359, "vx":1.83569, "vy":-0.79005, "omega":-3.82383, "ax":-0.28056, "ay":-0.64929, "alpha":0.68498, "fx":[-5.97766,-5.04494,-2.95501,-3.83861], "fy":[-8.91911,-13.96534,-11.09007,-7.25746]}, - {"t":0.32408, "x":6.20453, "y":2.00267, "heading":0.33195, "vx":1.8319, "vy":-0.79882, "omega":-3.81458, "ax":-0.36096, "ay":-0.81992, "alpha":2.1293, "fx":[-13.10459,-9.80944,0.99092,-0.99895], "fy":[-9.21337,-19.82445,-16.23275,-6.79681]}, - {"t":0.33759, "x":6.22923, "y":1.9918, "heading":0.28044, "vx":1.82703, "vy":-0.80989, "omega":-3.78583, "ax":-0.52677, "ay":-1.17458, "alpha":4.27343, "fx":[-22.10596,-16.21921,5.17966,-0.30567], "fy":[-11.3789,-32.64818,-25.88135,-4.68089]}, - {"t":0.35109, "x":6.25386, "y":1.98076, "heading":0.22932, "vx":1.81992, "vy":-0.82575, "omega":-3.72812, "ax":-0.65224, "ay":-1.41846, "alpha":8.2391, "fx":[-37.81855,-27.72849,15.8717,8.25612], "fy":[-7.4869,-46.45918,-37.58319,1.45298]}, - {"t":0.36459, "x":6.27837, "y":1.96948, "heading":0.17898, "vx":1.81111, "vy":-0.84491, "omega":-3.61686, "ax":-0.9069, "ay":-1.90514, "alpha":12.35931, "fx":[-55.39445,-40.92545,24.02699,14.70236], "fy":[-7.3809,-63.40709,-56.20136,6.00757]}, - {"t":0.3781, "x":6.30275, "y":1.9579, "heading":0.13014, "vx":1.79886, "vy":-0.87063, "omega":-3.44997, "ax":-1.06522, "ay":-2.15809, "alpha":16.75817, "fx":[-73.41707,-53.85564,32.97312,26.65508], "fy":[-0.96905,-75.76881,-72.18432,11.87732]}, - {"t":0.3916, "x":6.32694, "y":1.94594, "heading":0.08355, "vx":1.78448, "vy":-0.89978, "omega":-3.22368, "ax":-1.34738, "ay":-2.60203, "alpha":19.25185, "fx":[-88.91707,-62.977,32.25915,34.07218], "fy":[-3.1291,-83.2321,-89.53214,10.65696]}, - {"t":0.4051, "x":6.35091, "y":1.93356, "heading":0.04002, "vx":1.76628, "vy":-0.93491, "omega":-2.96371, "ax":-1.5549, "ay":-2.74394, "alpha":21.11643, "fx":[-99.75037,-70.69748,29.85678,41.85033], "fy":[1.52984,-85.44368,-99.62705,9.29272]}, - {"t":0.41861, "x":6.37462, "y":1.92068, "heading":0.0, "vx":1.74529, "vy":-0.97197, "omega":-2.67857, "ax":-1.44301, "ay":-2.6235, "alpha":23.55534, "fx":[-106.31042,-76.32688,31.60068,59.40094], "fy":[9.33144,-85.8818,-104.67115,14.62138]}, - {"t":0.44014, "x":6.41186, "y":1.89915, "heading":-0.05767, "vx":1.71422, "vy":-1.02845, "omega":-2.17144, "ax":-0.68798, "ay":-1.12854, "alpha":26.22803, "fx":[-87.9765,-79.99235,52.02727,72.25258], "fy":[46.95006,-72.87993,-88.97495,43.2393]}, - {"t":0.46167, "x":6.44861, "y":1.87675, "heading":-0.10442, "vx":1.69941, "vy":-1.05274, "omega":-1.60677, "ax":0.85053, "ay":1.40016, "alpha":25.22372, "fx":[-43.58383,-69.83471,85.81101,81.61897], "fy":[93.13019,-32.90325,-42.95455,71.64198]}, - {"t":0.48319, "x":6.48539, "y":1.85441, "heading":-0.13901, "vx":1.71772, "vy":-1.0226, "omega":-1.06373, "ax":1.69764, "ay":2.97677, "alpha":20.68259, "fx":[-16.25064,-52.03304,97.35356,78.73493], "fy":[105.56287,11.74183,-6.45462,78.18352]}, - {"t":0.50472, "x":6.52277, "y":1.83308, "heading":-0.16191, "vx":1.75427, "vy":-0.95851, "omega":-0.61845, "ax":1.66439, "ay":3.19315, "alpha":19.24836, "fx":[-12.88108,-49.79951,93.21929,75.1547], "fy":[103.68119,20.46026,0.4845,78.14864]}, - {"t":0.52625, "x":6.56092, "y":1.81318, "heading":-0.17522, "vx":1.7901, "vy":-0.88977, "omega":-0.20405, "ax":1.56384, "ay":3.31009, "alpha":18.02371, "fx":[-13.62888,-46.05605,86.75648,72.23681], "fy":[101.22935,28.54523,3.25651,77.16954]}, - {"t":0.54778, "x":6.59982, "y":1.79479, "heading":-0.17962, "vx":1.82377, "vy":-0.8185, "omega":0.18398, "ax":1.44267, "ay":3.39604, "alpha":17.18704, "fx":[-13.11745,-46.28164,82.65004,68.36294], "fy":[99.33787,30.0193,8.747,77.55419]}, - {"t":0.56931, "x":6.63942, "y":1.77796, "heading":-0.17566, "vx":1.85483, "vy":-0.74539, "omega":0.55401, "ax":1.31204, "ay":3.46636, "alpha":15.37783, "fx":[-14.4343,-37.94882,72.49915,63.20256], "fy":[95.21023,34.88835,13.19888,76.8264]}, - {"t":0.59084, "x":6.67966, "y":1.76272, "heading":-0.16373, "vx":1.88308, "vy":-0.67076, "omega":0.88508, "ax":1.17546, "ay":3.52595, "alpha":14.84312, "fx":[-14.8534,-40.20515,70.61906,59.08454], "fy":[93.32046,35.19888,18.24855,77.14041]}, - {"t":0.61237, "x":6.72047, "y":1.74909, "heading":-0.14467, "vx":1.90838, "vy":-0.59485, "omega":1.20464, "ax":1.03501, "ay":3.57703, "alpha":12.51293, "fx":[-14.77105,-29.30808,57.97846,51.82681], "fy":[88.04808,38.3854,24.36951,76.34916]}, - {"t":0.6339, "x":6.7618, "y":1.73711, "heading":-0.11874, "vx":1.93067, "vy":-0.51784, "omega":1.47403, "ax":0.89149, "ay":3.62058, "alpha":12.2599, "fx":[-16.53492,-32.56844,57.88966,47.82576], "fy":[86.36813,38.5086,28.45934,76.58117]}, - {"t":0.65543, "x":6.80357, "y":1.7268, "heading":-0.08701, "vx":1.94986, "vy":-0.43989, "omega":1.73797, "ax":0.74563, "ay":3.65714, "alpha":9.89352, "fx":[-15.14037,-22.5792,45.50249,39.56653], "fy":[80.92849,41.16324,34.6464,75.50109]}, - {"t":0.67696, "x":6.84572, "y":1.71818, "heading":-0.04959, "vx":1.96591, "vy":-0.36116, "omega":1.95097, "ax":0.59641, "ay":3.68722, "alpha":9.4601, "fx":[-17.18224,-24.0866,43.64733,35.49517], "fy":[78.8872,41.57484,38.47426,75.21295]}, - {"t":0.69849, "x":6.88818, "y":1.71126, "heading":-0.00759, "vx":1.97875, "vy":-0.28177, "omega":2.15464, "ax":0.42396, "ay":3.71317, "alpha":7.77602, "fx":[-16.37112,-19.10488,34.72934,27.66954], "fy":[74.68874,43.50369,43.28881,74.31604]}, - {"t":0.72002, "x":6.93088, "y":1.70606, "heading":0.0388, "vx":1.98788, "vy":-0.20183, "omega":2.32205, "ax":0.07514, "ay":3.73828, "alpha":6.52155, "fx":[-18.908,-19.68325,24.14548,19.21724], "fy":[71.54838,45.10705,47.55581,73.18052]}, - {"t":0.74154, "x":6.9737, "y":1.70258, "heading":0.08879, "vx":1.9895, "vy":-0.12135, "omega":2.46245, "ax":-0.47156, "ay":3.71072, "alpha":6.10709, "fx":[-26.53945,-27.4665,15.74987,8.31092], "fy":[68.14279,44.43076,50.21264,72.85534]}, - {"t":0.76307, "x":7.01642, "y":1.70082, "heading":0.14181, "vx":1.97934, "vy":-0.04146, "omega":2.59394, "ax":-0.93174, "ay":3.62402, "alpha":3.85541, "fx":[-27.04833,-25.5843,-1.91012,-4.62569], "fy":[63.65,47.46774,51.3006,67.71727]}, - {"t":0.7846, "x":7.05882, "y":1.70077, "heading":0.19765, "vx":1.95928, "vy":0.03656, "omega":2.67694, "ax":-1.27914, "ay":3.5176, "alpha":4.71435, "fx":[-35.34059,-35.27365,-1.4487,-9.16612], "fy":[60.57565,42.57746,52.32849,67.89613]}, - {"t":0.80613, "x":7.1007, "y":1.70237, "heading":0.25529, "vx":1.93175, "vy":0.11229, "omega":2.77843, "ax":-1.53965, "ay":3.41257, "alpha":1.87598, "fx":[-30.36205,-28.6925,-18.19513,-20.52266], "fy":[57.18395,48.6868,50.85183,59.98585]}, - {"t":0.82766, "x":7.14194, "y":1.70558, "heading":0.3151, "vx":1.8986, "vy":0.18576, "omega":2.81882, "ax":-1.73807, "ay":3.31671, "alpha":3.49768, "fx":[-39.00735,-38.09097,-12.90157,-20.3726], "fy":[54.38458,41.48904,52.58114,62.1658]}, - {"t":0.84919, "x":7.18241, "y":1.71035, "heading":0.37579, "vx":1.86118, "vy":0.25717, "omega":2.89412, "ax":-1.89232, "ay":3.23185, "alpha":0.55437, "fx":[-31.53227,-30.76313,-28.05558,-29.81686], "fy":[52.83585,49.5829,49.47679,53.33614]}, - {"t":0.87072, "x":7.22204, "y":1.71664, "heading":0.4381, "vx":1.82044, "vy":0.32674, "omega":2.90606, "ax":-2.01471, "ay":3.15756, "alpha":2.37612, "fx":[-40.08303,-38.44734,-21.62452,-27.78499], "fy":[49.84688,41.98462,51.89011,56.7926]}, - {"t":0.89225, "x":7.26076, "y":1.7244, "heading":0.50066, "vx":1.77706, "vy":0.39472, "omega":2.95722, "ax":-2.11367, "ay":3.09266, "alpha":-0.31196, "fx":[-32.00765,-32.59614,-34.54402,-35.07636], "fy":[50.08836,50.0721,47.99162,48.24116]}, - {"t":0.91378, "x":7.29853, "y":1.73362, "heading":0.56433, "vx":1.73156, "vy":0.46131, "omega":2.9505, "ax":-2.19504, "ay":3.03586, "alpha":1.24055, "fx":[-39.40875,-37.81612,-29.33004,-32.83663], "fy":[46.88351,43.93037,50.2905,51.68167]}, - {"t":0.93531, "x":7.3353, "y":1.74425, "heading":0.62785, "vx":1.6843, "vy":0.52667, "omega":2.97721, "ax":-2.26296, "ay":2.98593, "alpha":-0.97116, "fx":[-32.01401,-34.28415,-39.35871,-38.04756], "fy":[48.42426,50.6423,46.41256,44.13647]}, - {"t":0.95684, "x":7.37104, "y":1.75628, "heading":0.69195, "vx":1.63558, "vy":0.59095, "omega":2.9563, "ax":-2.32039, "ay":2.94184, "alpha":-0.0289, "fx":[-36.95879,-37.20435,-36.62799,-36.56038], "fy":[45.69054,47.05705,47.82517,46.24256]}, - {"t":0.97836, "x":7.40572, "y":1.76969, "heading":0.75559, "vx":1.58563, "vy":0.65429, "omega":2.95568, "ax":-2.36952, "ay":2.90269, "alpha":-1.65186, "fx":[-31.13611,-35.93449,-43.66965,-39.73111], "fy":[47.81126,51.66585,44.57371,40.27834]}, - {"t":0.99989, "x":7.4393, "y":1.78445, "heading":0.81923, "vx":1.53461, "vy":0.71678, "omega":2.92011, "ax":-2.41198, "ay":2.86775, "alpha":-1.44613, "fx":[-33.00977,-37.45506,-43.68755,-39.0152], "fy":[46.31842,50.81595,44.6364,40.3397]}, - {"t":1.02142, "x":7.47178, "y":1.80054, "heading":0.88209, "vx":1.48269, "vy":0.77852, "omega":2.88898, "ax":-2.44901, "ay":2.83641, "alpha":-2.58887, "fx":[-28.7971,-37.74255,-48.46153,-40.51784], "fy":[48.55661,53.65207,42.04451,35.8672]}, - {"t":1.04295, "x":7.50314, "y":1.81796, "heading":0.94429, "vx":1.42996, "vy":0.83958, "omega":2.83324, "ax":-2.48156, "ay":2.80817, "alpha":-3.03593, "fx":[-27.98177,-38.84859,-50.6723,-40.08344], "fy":[48.78216,54.93316,40.70462,33.90728]}, - {"t":1.06448, "x":7.53335, "y":1.83669, "heading":1.00529, "vx":1.37653, "vy":0.90004, "omega":2.76788, "ax":-2.51039, "ay":2.78261, "alpha":-4.03166, "fx":[-24.34407,-40.06924,-54.58119,-40.42242], "fy":[51.35649,57.11581,38.1778,30.05364]}, - {"t":1.08601, "x":7.5624, "y":1.85671, "heading":1.06488, "vx":1.32249, "vy":0.95995, "omega":2.68108, "ax":-2.53608, "ay":2.75937, "alpha":-4.93324, "fx":[-21.83922,-41.45082,-58.09704,-39.66135], "fy":[53.35258,59.586,35.6727,26.61701]}, - {"t":1.10754, "x":7.59029, "y":1.87801, "heading":1.1226, "vx":1.26789, "vy":1.01935, "omega":2.57488, "ax":-2.55912, "ay":2.73817, "alpha":-6.03122, "fx":[-18.0164,-43.4719,-62.06825,-38.95497], "fy":[56.7791,61.79678,32.61037,22.69533]}, - {"t":1.12907, "x":7.61699, "y":1.90059, "heading":1.17804, "vx":1.21279, "vy":1.07831, "omega":2.44503, "ax":-2.5861, "ay":2.71091, "alpha":-5.21297, "fx":[-21.89929,-44.5643,-59.49174,-38.26936], "fy":[55.25966,58.53385,32.64899,25.70846]}, - {"t":1.15577, "x":7.64845, "y":1.93036, "heading":1.24333, "vx":1.14374, "vy":1.15069, "omega":2.30583, "ax":-2.6246, "ay":2.67592, "alpha":-4.41748, "fx":[-26.20867,-45.29552,-57.02363,-38.14188], "fy":[53.25039,55.73771,32.69454,28.24625]}, - {"t":1.18247, "x":7.67806, "y":1.96204, "heading":1.3049, "vx":1.07365, "vy":1.22215, "omega":2.18787, "ax":-2.66527, "ay":2.63528, "alpha":-3.83934, "fx":[-29.01308,-46.4954,-55.41454,-38.32963], "fy":[52.10057,52.58522,32.54601,30.11607]}, - {"t":1.20918, "x":7.70578, "y":1.99561, "heading":1.36332, "vx":1.00248, "vy":1.29252, "omega":2.08535, "ax":-2.7097, "ay":2.58942, "alpha":-3.29452, "fx":[-32.25254,-46.98111,-53.94778,-38.89276], "fy":[50.10772,50.47314,32.51963,31.33519]}, - {"t":1.23588, "x":7.73158, "y":2.03105, "heading":1.41901, "vx":0.93012, "vy":1.36167, "omega":1.99737, "ax":-2.75837, "ay":2.53734, "alpha":-2.87597, "fx":[-34.47426,-48.02443,-53.06421,-39.60186], "fy":[48.81567,47.71207,32.34173,32.25915]}, - {"t":1.26258, "x":7.75543, "y":2.06831, "heading":1.47234, "vx":0.85647, "vy":1.42942, "omega":1.92057, "ax":-2.81181, "ay":2.4778, "alpha":-2.48308, "fx":[-37.13165,-48.4414,-52.36784,-40.6173], "fy":[46.69317,46.012,32.0554,32.58682]}, - {"t":1.28929, "x":7.7773, "y":2.10737, "heading":1.52363, "vx":0.78138, "vy":1.49558, "omega":1.85427, "ax":-2.87061, "ay":2.4092, "alpha":-2.18458, "fx":[-39.03972,-49.50679,-52.10648,-41.63922], "fy":[45.29587,43.39734,31.59734,32.70101]}, - {"t":1.31599, "x":7.79714, "y":2.14816, "heading":1.57314, "vx":0.70473, "vy":1.55992, "omega":1.79593, "ax":-2.93542, "ay":2.32955, "alpha":-1.89622, "fx":[-41.37548,-50.04887,-52.03743,-42.94576], "fy":[42.99751,41.7674,30.89206,32.27606]}, - {"t":1.34269, "x":7.81492, "y":2.19065, "heading":1.6211, "vx":0.62634, "vy":1.62212, "omega":1.7453, "ax":-3.00689, "ay":2.23622, "alpha":-1.68223, "fx":[-43.16714,-51.23349,-52.31163,-44.23399], "fy":[41.32095,39.08266,29.97804,31.62514]}, - {"t":1.3694, "x":7.83057, "y":2.23476, "heading":1.6677, "vx":0.54605, "vy":1.68184, "omega":1.70038, "ax":-3.08564, "ay":2.12587, "alpha":-1.46572, "fx":[-45.34736,-51.99867,-52.7585,-45.84269], "fy":[38.70963,37.19856,28.68029,30.4107]}, - {"t":1.3961, "x":7.84405, "y":2.28043, "heading":1.71311, "vx":0.46365, "vy":1.73861, "omega":1.66124, "ax":-3.17211, "ay":1.99411, "alpha":-1.31304, "fx":[-47.19485,-53.39217,-53.5258,-47.32523], "fy":[36.47806,34.16251,27.07931,28.91191]}, - {"t":1.4228, "x":7.8553, "y":2.32757, "heading":1.75747, "vx":0.37895, "vy":1.79185, "omega":1.62618, "ax":-3.26629, "ay":1.83523, "alpha":-1.14268, "fx":[-49.38848,-54.43258,-54.41355,-49.18409], "fy":[33.20957,31.65723,24.9417,26.73403]}, - {"t":1.44951, "x":7.86425, "y":2.37607, "heading":1.80089, "vx":0.29173, "vy":1.84086, "omega":1.59566, "ax":-3.36729, "ay":1.64186, "alpha":-1.03987, "fx":[-51.32411,-56.03601,-55.60071,-50.87212], "fy":[30.07071,27.87538,22.25446,24.06233]}, - {"t":1.47621, "x":7.87084, "y":2.42581, "heading":1.8435, "vx":0.20181, "vy":1.8847, "omega":1.5679, "ax":-3.47254, "ay":1.4047, "alpha":-0.89193, "fx":[-53.54847,-57.32823,-56.80648,-52.83315], "fy":[25.51909,24.21736,18.87435,20.59193]}, - {"t":1.50291, "x":7.87499, "y":2.47664, "heading":1.88537, "vx":0.10909, "vy":1.92221, "omega":1.54408, "ax":-3.57638, "ay":1.11277, "alpha":-0.8361, "fx":[-55.41495,-58.96716,-58.15376,-54.57453], "fy":[21.00415,19.03381,14.48845,16.1377]}, - {"t":1.52961, "x":7.87663, "y":2.52836, "heading":1.9266, "vx":0.01359, "vy":1.95193, "omega":1.52175, "ax":-3.66818, "ay":0.75494, "alpha":-0.71444, "fx":[-57.31546,-60.15508,-59.28365,-56.18571], "fy":[14.55897,13.48249,9.18675,10.71292]}, - {"t":1.55632, "x":7.87569, "y":2.58076, "heading":1.96724, "vx":-0.08437, "vy":1.97209, "omega":1.50267, "ax":-3.73041, "ay":0.32568, "alpha":-0.68477, "fx":[-58.4467,-61.11983,-60.0212,-57.3042], "fy":[7.95434,6.2605,2.52907,3.93785]}, - {"t":1.58302, "x":7.8721, "y":2.63353, "heading":2.00736, "vx":-0.18398, "vy":1.98078, "omega":1.48439, "ax":-3.74093, "ay":-0.15546, "alpha":-0.60214, "fx":[-58.92376,-61.11495,-59.97692,-57.54415], "fy":[-0.20477,-1.31498,-4.79631,-3.55624]}, - {"t":1.60972, "x":7.86586, "y":2.68637, "heading":2.047, "vx":-0.28387, "vy":1.97663, "omega":1.46831, "ax":-3.70068, "ay":-0.56633, "alpha":-0.58445, "fx":[-58.38121,-60.47982,-59.14361,-56.99929], "fy":[-6.71543,-7.92556,-11.25566,-10.06667]}, - {"t":1.63643, "x":7.85696, "y":2.73895, "heading":2.08621, "vx":-0.38269, "vy":1.96151, "omega":1.4527, "ax":-3.65599, "ay":-0.80424, "alpha":-0.51396, "fx":[-57.83867,-59.60248,-58.32238,-56.40275], "fy":[-10.78851,-11.88228,-14.73958,-13.66106]}, - {"t":1.66313, "x":7.84544, "y":2.79104, "heading":2.125, "vx":-0.48032, "vy":1.94003, "omega":1.43898, "ax":-3.59936, "ay":-1.02727, "alpha":-0.515, "fx":[-57.01228,-58.77014,-57.29143,-55.49587], "fy":[-14.30581,-15.4806,-18.27809,-17.17011]}, - {"t":1.68983, "x":7.83133, "y":2.84248, "heading":2.16342, "vx":-0.57643, "vy":1.9126, "omega":1.42523, "ax":-3.44259, "ay":-1.46881, "alpha":-0.47581, "fx":[-54.69867,-56.19761,-54.7615,-52.95699], "fy":[-21.53237,-22.60256,-25.05232,-24.08628]}, - {"t":1.71654, "x":7.81471, "y":2.89303, "heading":2.20148, "vx":-0.66836, "vy":1.87338, "omega":1.41252, "ax":-3.09993, "ay":-2.09744, "alpha":-0.4931, "fx":[-49.29883,-50.96133,-49.12134,-47.47308], "fy":[-31.56504,-32.44057,-35.09591,-34.09177]}, - {"t":1.74324, "x":7.79575, "y":2.94231, "heading":2.2392, "vx":-0.75114, "vy":1.81737, "omega":1.39935, "ax":-2.63429, "ay":-2.65921, "alpha":-0.48708, "fx":[-42.09646,-43.49877,-41.72243,-39.96774], "fy":[-40.35796,-41.70259,-43.86126,-42.94562]}, - {"t":1.76994, "x":7.77476, "y":2.98989, "heading":2.27657, "vx":-0.82148, "vy":1.74636, "omega":1.38635, "ax":-2.12587, "ay":-3.08142, "alpha":-0.51137, "fx":[-33.96684,-35.81596,-33.48929,-31.72708], "fy":[-47.35666,-48.09279,-50.63561,-49.59428]}, - {"t":1.79664, "x":7.75206, "y":3.03542, "heading":2.31359, "vx":-0.87825, "vy":1.66408, "omega":1.37269, "ax":-1.64046, "ay":-3.36566, "alpha":-0.51139, "fx":[-26.40661,-28.01506,-25.79893,-23.95316], "fy":[-51.67505,-53.05436,-55.06492,-53.93492]}, - {"t":1.82335, "x":7.72803, "y":3.07866, "heading":2.35024, "vx":-0.92205, "vy":1.57421, "omega":1.35904, "ax":-1.21223, "ay":-3.54309, "alpha":-0.56812, "fx":[-19.57801,-21.67287,-18.88094,-16.84851], "fy":[-54.56758,-55.72086,-58.02339,-56.68499]}, - {"t":1.85005, "x":7.70297, "y":3.11943, "heading":2.38653, "vx":-0.95442, "vy":1.4796, "omega":1.34387, "ax":-0.84969, "ay":-3.6476, "alpha":-0.59901, "fx":[-13.92367,-15.94442,-13.08375,-11.00613], "fy":[-55.95214,-57.71466,-59.76483,-58.20141]}, - {"t":1.87675, "x":7.67718, "y":3.15764, "heading":2.42242, "vx":-0.97711, "vy":1.38219, "omega":1.32787, "ax":-0.54809, "ay":-3.7054, "alpha":-0.68432, "fx":[-9.21027,-11.6638,-8.17938,-5.75187], "fy":[-56.82897,-58.53891,-60.90222,-59.03364]}, - {"t":1.90346, "x":7.6509, "y":3.19323, "heading":2.45788, "vx":-0.99175, "vy":1.28325, "omega":1.3096, "ax":-0.29816, "ay":-3.73423, "alpha":-0.76381, "fx":[-5.37826,-7.92332,-4.09374,-1.53875], "fy":[-56.84804,-59.3438,-61.57765,-59.36513]}, - {"t":1.93016, "x":7.62431, "y":3.22616, "heading":2.49285, "vx":-0.99971, "vy":1.18353, "omega":1.2892, "ax":-0.09037, "ay":-3.74537, "alpha":-0.86995, "fx":[-2.23855,-5.19108,-0.6381,2.32875], "fy":[-56.94684,-59.45797,-62.04496,-59.39213]}, - {"t":1.95686, "x":7.59758, "y":3.25643, "heading":2.52727, "vx":-1.00213, "vy":1.08352, "omega":1.26597, "ax":0.08358, "ay":-3.74582, "alpha":-0.99901, "fx":[0.32245,-2.88479,2.33917,5.53056], "fy":[-56.39438,-59.87002,-62.37615,-59.23013]}, - {"t":1.98357, "x":7.57085, "y":3.28403, "heading":2.56108, "vx":-0.99989, "vy":0.9835, "omega":1.23929, "ax":0.23043, "ay":-3.73992, "alpha":-1.13803, "fx":[2.37991,-1.20479,4.89803,8.55982], "fy":[-56.11298,-59.83301,-62.65064,-58.89909]}, - {"t":2.01027, "x":7.54423, "y":3.30896, "heading":2.59417, "vx":-0.99374, "vy":0.88363, "omega":1.20891, "ax":0.35551, "ay":-3.73033, "alpha":-1.31855, "fx":[4.05256,0.08122,7.22865,11.21355], "fy":[-55.34287,-60.11497,-62.92926,-58.49969]}, - {"t":2.03697, "x":7.51782, "y":3.33122, "heading":2.62645, "vx":-0.98425, "vy":0.78402, "omega":1.1737, "ax":0.46298, "ay":-3.71871, "alpha":-1.50301, "fx":[5.35255,1.01217,9.26248,13.77352], "fy":[-54.81666,-60.11898,-63.22196,-57.99164]}, - {"t":2.06368, "x":7.49171, "y":3.35083, "heading":2.65779, "vx":-0.97188, "vy":0.68472, "omega":1.13356, "ax":0.55609, "ay":-3.70611, "alpha":-1.75205, "fx":[6.34542,1.5381,11.23191,16.19822], "fy":[-53.82618,-60.48275,-63.58321,-57.4564]}, - {"t":2.09038, "x":7.46595, "y":3.3678, "heading":2.68806, "vx":-0.95703, "vy":0.58575, "omega":1.08678, "ax":0.6374, "ay":-3.69314, "alpha":-1.98434, "fx":[7.06936,1.89097,12.99581,18.52055], "fy":[-53.20709,-60.58539,-63.95147,-56.78145]}, - {"t":2.11708, "x":7.44062, "y":3.38212, "heading":2.71708, "vx":-0.94001, "vy":0.48713, "omega":1.03379, "ax":0.70891, "ay":-3.68022, "alpha":-2.27595, "fx":[7.52356,1.90872,14.7426,20.84268], "fy":[-52.29627,-60.93925,-64.40456,-56.06479]}, - {"t":2.14378, "x":7.41577, "y":3.39382, "heading":2.74469, "vx":-0.92108, "vy":0.38886, "omega":0.97301, "ax":-1.21445, "ay":-3.54251, "alpha":-2.11985, "fx":[-24.0452,-27.12894,-14.86742,-11.07955], "fy":[-49.9393,-57.56342,-62.39814,-55.05862]}, - {"t":2.17888, "x":7.3827, "y":3.40528, "heading":2.77884, "vx":-0.96371, "vy":0.26452, "omega":0.89861, "ax":-0.76062, "ay":-3.66411, "alpha":-1.77084, "fx":[-16.1144,-18.77321,-8.25543,-5.15827], "fy":[-53.22381,-59.4215,-63.14886,-56.88736]}, - {"t":2.21398, "x":7.3484, "y":3.41231, "heading":2.81038, "vx":-0.99041, "vy":0.13591, "omega":0.83645, "ax":-0.15431, "ay":-1.36146, "alpha":-1.90384, "fx":[-6.11974,-9.01619,1.11858,4.21813], "fy":[-15.62692,-24.19799,-27.49493,-19.13665]}, - {"t":2.24908, "x":7.31354, "y":3.41624, "heading":2.83974, "vx":-0.99582, "vy":0.08812, "omega":0.76963, "ax":0.0271, "ay":0.28943, "alpha":-1.70123, "fx":[-2.78344,-5.22026,3.64928,6.07562], "fy":[10.05334,1.99977,-0.84522,7.1715]}, - {"t":2.28418, "x":7.27861, "y":3.41951, "heading":2.86676, "vx":-0.99487, "vy":0.09828, "omega":0.70991, "ax":0.01536, "ay":0.15139, "alpha":-1.4028, "fx":[-2.52544,-4.38087,3.02446,4.85753], "fy":[6.7971,0.33332,-2.11954,4.60253]}, - {"t":2.31928, "x":7.2437, "y":3.42306, "heading":2.89167, "vx":-0.99433, "vy":0.10359, "omega":0.66068, "ax":0.00943, "ay":0.08914, "alpha":-1.16552, "fx":[-2.23135,-3.63902,2.53785,3.93133], "fy":[5.02018,-0.38336,-2.31328,3.33731]}, - {"t":2.35438, "x":7.2088, "y":3.42675, "heading":2.91486, "vx":-0.994, "vy":0.10672, "omega":0.61977, "ax":0.00761, "ay":0.07008, "alpha":-0.9734, "fx":[-1.92042,-2.98906,2.16592,3.227], "fy":[4.10271,-0.5059,-1.95488,2.80865]}, - {"t":2.38948, "x":7.17392, "y":3.43054, "heading":2.93662, "vx":-0.99374, "vy":0.10918, "omega":0.5856, "ax":0.00644, "ay":0.05809, "alpha":-0.81557, "fx":[-1.64427,-2.45612,1.85071,2.65881], "fy":[3.41524,-0.54175,-1.6042,2.41939]}, - {"t":2.42458, "x":7.13904, "y":3.43441, "heading":2.95717, "vx":-0.99351, "vy":0.11122, "omega":0.55697, "ax":0.00551, "ay":0.04883, "alpha":-0.68555, "fx":[-1.40599,-2.02333,1.58182,2.19734], "fy":[2.86245,-0.54392,-1.31301,2.09515]}, - {"t":2.45968, "x":7.10417, "y":3.43834, "heading":2.97672, "vx":-0.99332, "vy":0.11294, "omega":0.53291, "ax":0.00484, "ay":0.04228, "alpha":-0.5797, "fx":[-1.20435,-1.67557,1.35845,1.82876], "fy":[2.42931,-0.51277,-1.06785,1.83599]}, - {"t":2.49478, "x":7.06931, "y":3.44233, "heading":2.99543, "vx":-0.99315, "vy":0.11442, "omega":0.51256, "ax":0.00437, "ay":0.03768, "alpha":-0.49316, "fx":[-1.03368,-1.39447,1.17257,1.53287], "fy":[2.08841,-0.46095,-0.86274,1.62801]}, - {"t":2.52988, "x":7.03445, "y":3.44637, "heading":3.01342, "vx":-0.99299, "vy":0.11574, "omega":0.49525, "ax":0.00401, "ay":0.03424, "alpha":-0.42522, "fx":[-0.89787,-1.17706,1.02539,1.3043], "fy":[1.82246,-0.40744,-0.70293,1.46206]}, - {"t":2.56498, "x":6.9996, "y":3.45045, "heading":3.0308, "vx":-0.99285, "vy":0.11694, "omega":0.48033, "ax":0.00373, "ay":0.03151, "alpha":-0.371, "fx":[-0.78785,-1.00533,0.90637,1.12367], "fy":[1.61076,-0.35792,-0.57854,1.32693]}, - {"t":2.60008, "x":6.96475, "y":3.45458, "heading":3.04766, "vx":-0.99272, "vy":0.11805, "omega":0.46731, "ax":0.0035, "ay":0.02933, "alpha":-0.33208, "fx":[-0.71095,-0.88368,0.82225,0.99486], "fy":[1.45208,-0.32246,-0.4923,1.22539]}, - {"t":2.63518, "x":6.92991, "y":3.45874, "heading":3.06406, "vx":-0.9926, "vy":0.11908, "omega":0.45565, "ax":0.00333, "ay":0.02761, "alpha":-0.30345, "fx":[-0.65547,-0.7938,0.76113,0.89937], "fy":[1.33188,-0.29767,-0.43055,1.14976]}, - {"t":2.67028, "x":6.89507, "y":3.46294, "heading":3.08006, "vx":-0.99248, "vy":0.12005, "omega":0.445, "ax":0.00319, "ay":0.02629, "alpha":-0.28831, "fx":[-0.63241,-0.74551,0.73381,0.84684], "fy":[1.25472,-0.29233,-0.39942,1.1066]}, - {"t":2.70538, "x":6.86024, "y":3.46717, "heading":3.09567, "vx":-0.99237, "vy":0.12097, "omega":0.43488, "ax":0.0031, "ay":0.02532, "alpha":-0.28191, "fx":[-0.62971,-0.72188,0.7281,0.82021], "fy":[1.20775,-0.30113,-0.38697,1.08806]}, - {"t":2.74048, "x":6.82541, "y":3.47143, "heading":3.11094, "vx":-0.99226, "vy":0.12186, "omega":0.42498, "ax":0.00304, "ay":0.02465, "alpha":-0.2883, "fx":[-0.66063,-0.73528,0.75711,0.83172], "fy":[1.19777,-0.33338,-0.40162,1.10245]}, - {"t":2.77558, "x":6.79058, "y":3.47572, "heading":3.12586, "vx":-0.99215, "vy":0.12273, "omega":0.41486, "ax":0.00301, "ay":0.02426, "alpha":-0.30368, "fx":[-0.71504,-0.77207,0.81067,0.86764], "fy":[1.21503,-0.38443,-0.434,1.14368]}, - {"t":2.81068, "x":6.75576, "y":3.48004, "heading":3.14042, "vx":-0.99205, "vy":0.12358, "omega":0.4042, "ax":0.00302, "ay":0.02412, "alpha":-0.33224, "fx":[-0.80659,-0.84447,0.90237,0.94019], "fy":[1.26699,-0.46359,-0.49251,1.22109]}, - {"t":2.84578, "x":6.72094, "y":3.48439, "heading":-3.12858, "vx":-0.99194, "vy":0.12442, "omega":0.39254, "ax":0.00305, "ay":0.02425, "alpha":-0.37185, "fx":[-0.92955,-0.94405,1.02651,1.04093], "fy":[1.34827,-0.56906,-0.57146,1.33226]}, - {"t":2.88088, "x":6.68613, "y":3.48878, "heading":-3.1148, "vx":-0.99184, "vy":0.12528, "omega":0.37949, "ax":0.00312, "ay":0.02464, "alpha":-0.42633, "fx":[-1.09648,-1.08116,1.1957,1.18026], "fy":[1.4657,-0.7097,-0.678,1.48664]}, - {"t":2.91598, "x":6.65132, "y":3.49319, "heading":-3.10148, "vx":-0.99173, "vy":0.12614, "omega":0.36453, "ax":0.00323, "ay":0.0253, "alpha":-0.49582, "fx":[-1.30822,-1.25401,1.41086,1.35648], "fy":[1.61914,-0.88822,-0.81115,1.68705]}, - {"t":2.95108, "x":6.61651, "y":3.49763, "heading":-3.08869, "vx":-0.99161, "vy":0.12703, "omega":0.34712, "ax":0.00338, "ay":0.02627, "alpha":-0.58363, "fx":[-1.57575,-1.47063,1.68313,1.57775], "fy":[1.81467,-1.11283,-0.97652,1.94299]}, - {"t":2.98618, "x":6.58171, "y":3.50211, "heading":-3.0765, "vx":-0.99149, "vy":0.12795, "omega":0.32664, "ax":0.00357, "ay":0.02759, "alpha":-0.69252, "fx":[-1.90786,-1.73664,2.02153,1.84989], "fy":[2.05784,-1.39147,-1.17829,2.26365]}, - {"t":3.02128, "x":6.54691, "y":3.50661, "heading":-3.06504, "vx":-0.99137, "vy":0.12892, "omega":0.30233, "ax":0.00383, "ay":0.0293, "alpha":-0.82565, "fx":[-2.31478,-2.05882,2.43658,2.17994], "fy":[2.35495,-1.7321,-1.42161,2.65929]}, - {"t":3.05638, "x":6.51211, "y":3.51116, "heading":-3.05443, "vx":-0.99123, "vy":0.12995, "omega":0.27335, "ax":0.00414, "ay":0.03147, "alpha":-0.98843, "fx":[-2.8138,-2.45037,2.94594,2.58136], "fy":[2.71704,-2.14769,-1.71643,3.1456]}, - {"t":3.09148, "x":6.47732, "y":3.51574, "heading":-3.04483, "vx":-0.99109, "vy":0.13105, "omega":0.23866, "ax":0.00454, "ay":0.03418, "alpha":-1.18469, "fx":[-3.41665,-2.91971,3.56186,3.06288], "fy":[3.15266,-2.64697,-2.07002,3.7351]}, - {"t":3.12658, "x":6.44254, "y":3.52036, "heading":-3.03645, "vx":-0.99093, "vy":0.13225, "omega":0.19707, "ax":0.00504, "ay":0.03761, "alpha":-1.4224, "fx":[-4.14829,-3.48761,4.31039,3.64586], "fy":[3.67992,-3.24492,-2.49746,4.4507]}, - {"t":3.16168, "x":6.40776, "y":3.52502, "heading":-3.02954, "vx":-0.99075, "vy":0.13357, "omega":0.14715, "ax":0.00572, "ay":0.04217, "alpha":-1.70722, "fx":[-5.02419,-4.16807,5.20962,4.34574], "fy":[4.31836,-3.94749,-3.00679,5.31415]}, - {"t":3.19678, "x":6.37299, "y":3.52974, "heading":-3.02437, "vx":-0.99055, "vy":0.13505, "omega":0.08723, "ax":0.00668, "ay":0.04868, "alpha":-2.0495, "fx":[-6.0738,-4.98969,6.29415,5.19356], "fy":[5.10307,-4.76223,-3.61107,6.36185]}, - {"t":3.23188, "x":6.33822, "y":3.53451, "heading":-3.02131, "vx":-0.99032, "vy":0.13676, "omega":0.01529, "ax":0.00806, "ay":0.05793, "alpha":-2.45805, "fx":[-7.31757,-5.97826,7.59113,6.21653], "fy":[6.07059,-5.69504,-4.32217,7.62517]}, - {"t":3.26698, "x":6.30347, "y":3.53935, "heading":-3.02077, "vx":-0.99003, "vy":0.13879, "omega":-0.07099, "ax":0.0099, "ay":0.06996, "alpha":-2.94578, "fx":[-8.78807,-7.17693,9.13876,7.45465], "fy":[7.25812,-6.77071,-5.17338,9.12862]}, - {"t":3.30208, "x":6.26872, "y":3.54426, "heading":-3.02327, "vx":-0.98969, "vy":0.14125, "omega":-0.17438, "ax":0.01283, "ay":0.08889, "alpha":-3.52766, "fx":[-10.50371,-8.62494,10.98044,8.96291], "fy":[8.7842,-7.96792,-6.13767,10.96633]}, - {"t":3.33718, "x":6.23399, "y":3.54927, "heading":-3.02939, "vx":-0.98924, "vy":0.14437, "omega":-0.29821, "ax":0.02235, "ay":0.15037, "alpha":-4.22946, "fx":[-12.41962,-10.30361,13.23858,10.90416], "fy":[11.31118,-8.83203,-6.70177,13.77128]}, - {"t":3.37228, "x":6.19929, "y":3.55443, "heading":-3.03985, "vx":-0.98845, "vy":0.14965, "omega":-0.44666, "ax":0.04529, "ay":0.28913, "alpha":-5.0845, "fx":[-14.50054,-12.1414,15.97662,13.54142], "fy":[15.51091,-9.01954,-6.35111,18.22047]}, - {"t":3.40738, "x":6.16462, "y":3.55986, "heading":-3.05553, "vx":-0.98686, "vy":0.1598, "omega":-0.62512, "ax":-0.18547, "ay":-1.36625, "alpha":-5.61483, "fx":[-20.78244,-17.21837,13.73918,12.48397], "fy":[-10.01251,-35.74254,-33.5687,-7.43725]}, - {"t":3.44248, "x":6.12987, "y":3.56463, "heading":-3.07747, "vx":-0.99337, "vy":0.11184, "omega":-0.8222, "ax":-0.05974, "ay":-3.74496, "alpha":-5.19557, "fx":[-19.49671,-15.71235,15.04786,16.36757], "fy":[-50.55253,-70.15996,-68.72536,-48.37798]}, - {"t":3.47758, "x":6.09496, "y":3.56625, "heading":-3.10633, "vx":-0.99547, "vy":-0.01961, "omega":-1.00457, "ax":0.32943, "ay":-3.73398, "alpha":-6.11125, "fx":[-16.14981,-12.64657,23.11971,26.59672], "fy":[-48.76413,-71.99417,-70.04124,-46.31928]}, - {"t":3.51268, "x":6.06022, "y":3.56326, "heading":3.14159, "vx":-0.98391, "vy":-0.15067, "omega":-1.21907, "ax":0.36747, "ay":-3.7286, "alpha":-4.24682, "fx":[-8.24663,-7.33753,18.18534,20.73452], "fy":[-51.4739,-67.79175,-66.97517,-50.53629]}, - {"t":3.53711, "x":6.03629, "y":3.55847, "heading":3.1118, "vx":-0.97493, "vy":-0.24178, "omega":-1.32284, "ax":0.37896, "ay":-3.72904, "alpha":-3.71011, "fx":[-5.81673,-5.86768,16.58684,19.16261], "fy":[-52.04701,-66.57366,-66.22816,-51.95609]}, - {"t":3.56155, "x":6.01258, "y":3.55145, "heading":3.07948, "vx":-0.96567, "vy":-0.3329, "omega":-1.4135, "ax":0.39152, "ay":-3.72764, "alpha":-3.22497, "fx":[-3.6845,-4.51067,15.16294,17.89499], "fy":[-52.85755,-65.30912,-65.51014,-53.03951]}, - {"t":3.58598, "x":5.9891, "y":3.5422, "heading":3.04494, "vx":-0.9561, "vy":-0.42398, "omega":-1.4923, "ax":0.40554, "ay":-3.72604, "alpha":-2.81507, "fx":[-1.78291,-3.18834,13.9932,16.73103], "fy":[-53.25651,-64.40487,-64.88228,-54.07058]}, - {"t":3.61042, "x":5.96586, "y":3.53073, "heading":3.00848, "vx":-0.94619, "vy":-0.51502, "omega":-1.56108, "ax":0.42128, "ay":-3.72417, "alpha":-2.42448, "fx":[-0.0826,-1.90332,12.94941,15.78901], "fy":[-53.99157,-63.36244,-64.25311,-54.88844]}, - {"t":3.63485, "x":5.94287, "y":3.51703, "heading":2.97033, "vx":-0.9359, "vy":-0.60602, "omega":-1.62033, "ax":0.43908, "ay":-3.72197, "alpha":-2.1023, "fx":[1.47109,-0.65859,12.15858,14.91185], "fy":[-54.3071,-62.70197,-63.69364,-55.65347]}, - {"t":3.65929, "x":5.92013, "y":3.50111, "heading":2.93074, "vx":-0.92517, "vy":-0.69697, "omega":-1.6717, "ax":0.45937, "ay":-3.71937, "alpha":-1.79187, "fx":[2.83929,0.57426,11.4895,14.2683], "fy":[-54.97229,-61.8509,-63.1317,-56.23572]}, - {"t":3.68372, "x":5.89766, "y":3.48297, "heading":2.88989, "vx":-0.91394, "vy":-0.78785, "omega":-1.71548, "ax":0.48271, "ay":-3.71623, "alpha":-1.54122, "fx":[4.14762,1.76905,11.06553,13.6713], "fy":[-55.22607,-61.38225,-62.61919,-56.76379]}, - {"t":3.70816, "x":5.87547, "y":3.46261, "heading":2.84798, "vx":-0.90215, "vy":-0.87866, "omega":-1.75314, "ax":0.50984, "ay":-3.71239, "alpha":-1.29746, "fx":[5.30307,2.99023,10.76089,13.32194], "fy":[-55.79109,-60.67779,-62.12,-57.15883]}, - {"t":3.73259, "x":5.85358, "y":3.44003, "heading":2.80514, "vx":-0.88969, "vy":-0.96937, "omega":-1.78484, "ax":0.54175, "ay":-3.70762, "alpha":-1.11359, "fx":[6.49396,4.17727,10.68807,13.04349], "fy":[-55.868,-60.39483,-61.66659,-57.51523]}, - {"t":3.75703, "x":5.83201, "y":3.41524, "heading":2.76153, "vx":-0.87645, "vy":-1.05996, "omega":-1.81205, "ax":0.57983, "ay":-3.70156, "alpha":-0.91422, "fx":[7.56609,5.47023,10.7801,13.00435], "fy":[-56.42633,-59.73074,-61.185,-57.71764]}, - {"t":3.78146, "x":5.81076, "y":3.38823, "heading":2.71725, "vx":-0.86229, "vy":-1.15041, "omega":-1.83439, "ax":0.62603, "ay":-3.69366, "alpha":-0.78046, "fx":[8.78835,6.74671,11.12125,13.09858], "fy":[-56.37207,-59.57172,-60.73187,-57.88256]}, - {"t":3.8059, "x":5.78988, "y":3.35902, "heading":2.67243, "vx":-0.84699, "vy":-1.24067, "omega":-1.85346, "ax":0.68324, "ay":-3.68306, "alpha":-0.62113, "fx":[9.97017,8.24425,11.67891,13.49418], "fy":[-56.81783,-58.89203,-60.25577,-57.91922]}, - {"t":3.83033, "x":5.76939, "y":3.32761, "heading":2.62714, "vx":-0.83029, "vy":-1.33066, "omega":-1.86864, "ax":0.75584, "ay":-3.66827, "alpha":-0.52546, "fx":[11.4492,9.80484,12.57608,14.16817], "fy":[-56.63074,-58.7579,-59.71796,-57.83909]}, - {"t":3.85477, "x":5.74932, "y":3.294, "heading":2.58148, "vx":-0.81182, "vy":-1.42029, "omega":-1.88148, "ax":0.8509, "ay":-3.64663, "alpha":-0.40272, "fx":[13.11349,11.80704,13.86888,15.24505], "fy":[-56.77406,-58.02981,-59.13482,-57.63294]}, - {"t":3.8792, "x":5.72974, "y":3.2582, "heading":2.5355, "vx":-0.79103, "vy":-1.5094, "omega":-1.89132, "ax":0.98037, "ay":-3.61292, "alpha":-0.33609, "fx":[15.43037,14.17923,15.78417,16.86237], "fy":[-56.16077,-57.66411,-58.38024,-57.22616]}, - {"t":3.90364, "x":5.71071, "y":3.22024, "heading":2.48929, "vx":-0.76708, "vy":-1.59768, "omega":-1.89953, "ax":1.16607, "ay":-3.5558, "alpha":-0.23737, "fx":[18.38071,17.54458,18.59058,19.53287], "fy":[-55.78167,-56.35235,-57.28677,-56.38272]}, - {"t":3.92807, "x":5.69231, "y":3.18014, "heading":2.44287, "vx":-0.73859, "vy":-1.68456, "omega":-1.90533, "ax":1.45126, "ay":-3.44679, "alpha":-0.19576, "fx":[23.16414,22.29406,23.09183,23.60913], "fy":[-53.79794,-54.91999,-55.39569,-54.76748]}, - {"t":3.95251, "x":5.6747, "y":3.13795, "heading":2.39632, "vx":-0.70312, "vy":-1.76879, "omega":-1.91011, "ax":1.92801, "ay":-3.2001, "alpha":-0.12027, "fx":[30.59365,30.19303,30.55416,31.0935], "fy":[-50.46268,-50.57844,-51.33756,-50.83703]}, - {"t":3.97694, "x":5.65809, "y":3.09377, "heading":2.34965, "vx":-0.65601, "vy":-1.84698, "omega":-1.91305, "ax":2.76325, "ay":-2.50413, "alpha":-0.06198, "fx":[44.15443,43.69533,43.97886,43.64562], "fy":[-39.14781,-39.82967,-40.11624,-39.92576]}, - {"t":4.00138, "x":5.64289, "y":3.0479, "heading":2.3029, "vx":-0.58849, "vy":-1.90817, "omega":-1.91457, "ax":3.55302, "ay":-1.10226, "alpha":-0.04354, "fx":[56.41769,56.26657,56.3879,56.55483], "fy":[-17.2397,-17.69364,-17.62657,-17.43699]}, - {"t":4.02581, "x":5.62957, "y":3.00094, "heading":2.25612, "vx":-0.50168, "vy":-1.9351, "omega":-1.91563, "ax":3.61062, "ay":-0.85131, "alpha":0.04341, "fx":[57.51704,57.47324,57.5043,56.79013], "fy":[-13.50028,-13.46753,-13.51514,-13.57784]}, - {"t":4.05025, "x":5.61839, "y":2.9534, "heading":2.20931, "vx":-0.41345, "vy":-1.9559, "omega":-1.91457, "ax":3.62904, "ay":-0.68274, "alpha":0.02546, "fx":[57.59696,57.70377,57.62401,57.52994], "fy":[-11.00505,-10.71471,-10.76843,-10.86789]}, - {"t":4.07468, "x":5.60937, "y":2.90541, "heading":2.16253, "vx":-0.32478, "vy":-1.97259, "omega":-1.91395, "ax":3.6264, "ay":-0.51457, "alpha":0.11461, "fx":[57.76652,58.00222,57.83379,56.68443], "fy":[-8.30917,-8.26273,-7.91792,-8.18703]}, - {"t":4.09911, "x":5.60251, "y":2.85705, "heading":2.11576, "vx":-0.23617, "vy":-1.98516, "omega":-1.91115, "ax":3.58582, "ay":-0.34714, "alpha":0.10727, "fx":[56.85528,57.25866,56.99801,56.59798], "fy":[-6.00331,-5.52594,-5.09465,-5.42079]}, - {"t":4.12355, "x":5.59781, "y":2.80844, "heading":2.06906, "vx":-0.14855, "vy":-1.99364, "omega":-1.90853, "ax":3.45346, "ay":-0.18431, "alpha":0.23408, "fx":[54.99296,55.62352,55.24359,53.44494], "fy":[-3.5238,-3.15939,-2.29066,-2.73008]}, - {"t":4.14798, "x":5.59522, "y":2.75967, "heading":2.02243, "vx":-0.06416, "vy":-1.99815, "omega":-1.90281, "ax":3.02752, "ay":-0.04131, "alpha":0.22359, "fx":[47.86314,48.75352,48.26684,47.3731], "fy":[-1.51955,-0.98572,0.19832,-0.31644]}, - {"t":4.17242, "x":5.59455, "y":2.71084, "heading":1.97593, "vx":0.00981, "vy":-1.99916, "omega":-1.89734, "ax":1.66302, "ay":0.02502, "alpha":0.34621, "fx":[26.18652,27.55158,26.88388,24.98462], "fy":[-0.72094,-0.11612,1.51987,0.90591]}, - {"t":4.19685, "x":5.59529, "y":2.662, "heading":1.92957, "vx":0.05045, "vy":-1.99854, "omega":-1.88888, "ax":0.7059, "ay":0.02086, "alpha":0.39609, "fx":[10.70068,12.47241,11.7147,9.93897], "fy":[-1.07215,-0.33833,1.71053,1.02457]}, - {"t":4.22129, "x":5.59673, "y":2.61317, "heading":1.88342, "vx":0.0677, "vy":-1.99803, "omega":-1.87921, "ax":0.43165, "ay":0.01577, "alpha":0.48592, "fx":[6.11356,8.38447,7.54583,5.36739], "fy":[-1.38877,-0.70779,1.91938,1.17837]}, - {"t":4.24572, "x":5.59851, "y":2.56435, "heading":1.8375, "vx":0.07825, "vy":-1.99765, "omega":-1.86733, "ax":-0.05146, "ay":-0.002, "alpha":0.59945, "fx":[-1.77961,1.02142,0.14713,-2.65702], "fy":[-2.06014,-1.20269,1.95368,1.18204]}, - {"t":4.27016, "x":5.60041, "y":2.51554, "heading":1.79187, "vx":0.07699, "vy":-1.9977, "omega":-1.85269, "ax":0.12884, "ay":0.00507, "alpha":0.71761, "fx":[0.72622,4.17505,3.28902,-0.00862], "fy":[-2.23341,-1.52913,2.42973,1.65475]}, - {"t":4.29459, "x":5.60233, "y":2.46673, "heading":1.7466, "vx":0.08014, "vy":-1.99757, "omega":-1.83515, "ax":-0.0847, "ay":-0.00336, "alpha":0.8748, "fx":[-3.01015,1.17086,0.32161,-3.86125], "fy":[-2.84593,-2.03032,2.70295,1.96012]}, - {"t":4.31903, "x":5.60426, "y":2.41792, "heading":1.70176, "vx":0.07807, "vy":-1.99766, "omega":-1.81377, "ax":0.04973, "ay":0.00196, "alpha":1.04435, "fx":[-1.38461,3.67519,2.91278,-2.04557], "fy":[-3.15582,-2.54754,3.24549,2.58238]}, - {"t":4.34346, "x":5.60619, "y":2.3691, "heading":1.65744, "vx":0.07928, "vy":-1.99761, "omega":-1.78826, "ax":-0.03033, "ay":-0.00119, "alpha":1.25333, "fx":[-3.21766,2.85923,2.25376,-3.82147], "fy":[-3.78925,-3.15538,3.69687,3.17219]}, - {"t":4.3679, "x":5.60811, "y":2.32029, "heading":1.61374, "vx":0.07854, "vy":-1.99764, "omega":-1.75763, "ax":0.00031, "ay":0.03355, "alpha":1.48646, "fx":[-3.45346,3.82272,3.45343,-3.80278], "fy":[-3.83654,-3.27887,4.77658,4.46929]}, - {"t":4.39233, "x":5.61003, "y":2.27149, "heading":1.5708, "vx":0.07855, "vy":-1.99682, "omega":-1.72131, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":5.60786, "y":2.25453, "heading":1.5708, "vx":1.83691, "vy":-0.77605, "omega":-3.74654, "ax":0.28522, "ay":-0.15373, "alpha":-3.6123, "fx":[13.38203,-4.2876,-4.28645,13.30444], "fy":[7.70136,7.36616,-12.48027,-12.34931]}, + {"t":0.0135, "x":5.63269, "y":2.24404, "heading":1.52021, "vx":1.84076, "vy":-0.77813, "omega":-3.79531, "ax":-0.01925, "ay":-0.04939, "alpha":-1.69035, "fx":[4.04022,-4.1625,-4.64583,3.54576], "fy":[3.72465,4.06821,-5.26625,-5.66279]}, + {"t":0.02701, "x":5.65755, "y":2.23352, "heading":1.46896, "vx":1.8405, "vy":-0.7788, "omega":-3.81814, "ax":0.00408, "ay":0.00966, "alpha":-0.70417, "fx":[1.93074,-1.44153,-1.84352,1.61357], "fy":[1.93168,2.25242,-1.61196,-1.95871]}, + {"t":0.04051, "x":5.6824, "y":2.22301, "heading":1.4174, "vx":1.84056, "vy":-0.77866, "omega":-3.82765, "ax":-0.00288, "ay":-0.00668, "alpha":-0.25145, "fx":[0.6422,-0.52098,-0.73371,0.42938], "fy":[0.47251,0.7262,-0.71549,-0.90739]}, + {"t":0.05401, "x":5.70725, "y":2.21249, "heading":1.36572, "vx":1.84052, "vy":-0.77875, "omega":-3.83104, "ax":0.006, "ay":0.01396, "alpha":-0.07712, "fx":[0.2996,-0.05282,-0.14424,0.27861], "fy":[0.38733,0.46239,0.05805,-0.02137]}, + {"t":0.06752, "x":5.73211, "y":2.20198, "heading":1.31399, "vx":1.8406, "vy":-0.77857, "omega":-3.83208, "ax":0.00275, "ay":0.00681, "alpha":-0.01316, "fx":[0.07574,0.03115,0.01145,0.05618], "fy":[0.14459,0.15614,0.07951,0.05224]}, + {"t":0.08102, "x":5.75696, "y":2.19147, "heading":1.26224, "vx":1.84064, "vy":-0.77847, "omega":-3.83226, "ax":0.00758, "ay":0.01755, "alpha":-0.00218, "fx":[0.12709,0.11471,0.10339,0.13604], "fy":[0.24963,0.30126,0.28666,0.27675]}, + {"t":0.09452, "x":5.78182, "y":2.18096, "heading":1.21049, "vx":1.84074, "vy":-0.77824, "omega":-3.83229, "ax":0.00588, "ay":0.01433, "alpha":0.00326, "fx":[0.08463,0.10047,0.10195,0.08613], "fy":[0.25274,0.19027,0.24057,0.22611]}, + {"t":0.10802, "x":5.80667, "y":2.17045, "heading":1.15875, "vx":1.84082, "vy":-0.77804, "omega":-3.83225, "ax":0.0096, "ay":0.02226, "alpha":-0.00507, "fx":[0.18031,0.15135,0.13048,0.14732], "fy":[0.31759,0.39363,0.36037,0.34206]}, + {"t":0.12153, "x":5.83153, "y":2.15995, "heading":1.107, "vx":1.84095, "vy":-0.77774, "omega":-3.83231, "ax":0.00863, "ay":0.0209, "alpha":0.00159, "fx":[0.13633,0.14017,0.1377,0.13384], "fy":[0.37704,0.2845,0.34878,0.31679]}, + {"t":0.13503, "x":5.85639, "y":2.14945, "heading":1.05525, "vx":1.84106, "vy":-0.77746, "omega":-3.83229, "ax":0.01182, "ay":0.02756, "alpha":-0.00947, "fx":[0.23468,0.18963,0.15366,0.17284], "fy":[0.39945,0.49492,0.44341,0.41215]}, + {"t":0.14853, "x":5.88125, "y":2.13895, "heading":1.0035, "vx":1.84122, "vy":-0.77709, "omega":-3.83242, "ax":0.01099, "ay":0.02646, "alpha":0.00497, "fx":[0.16031,0.17873,0.18854,0.17025], "fy":[0.48077,0.34729,0.45134,0.40114]}, + {"t":0.16204, "x":5.90611, "y":2.12846, "heading":0.95175, "vx":1.84137, "vy":-0.77673, "omega":-3.83235, "ax":0.0132, "ay":0.03095, "alpha":-0.01193, "fx":[0.26373,0.2146,0.16758,0.19209], "fy":[0.45019,0.55602,0.49982,0.45951]}, + {"t":0.17554, "x":5.93098, "y":2.11797, "heading":0.90001, "vx":1.84155, "vy":-0.77631, "omega":-3.83252, "ax":0.01147, "ay":0.02747, "alpha":0.01278, "fx":[0.13588,0.18364,0.22804,0.18097], "fy":[0.51594,0.31804,0.49035,0.42041]}, + {"t":0.18904, "x":5.95585, "y":2.10749, "heading":0.84825, "vx":1.84171, "vy":-0.77594, "omega":-3.83234, "ax":0.0115, "ay":0.02721, "alpha":-0.01301, "fx":[0.23303,0.18457,0.13367,0.17914], "fy":[0.39982,0.4941,0.43833,0.39583]}, + {"t":0.20255, "x":5.98072, "y":2.09702, "heading":0.79651, "vx":1.84186, "vy":-0.77558, "omega":-3.83252, "ax":0.00693, "ay":0.0164, "alpha":0.02542, "fx":[0.01309,0.09563,0.2059,0.12554], "fy":[0.36751,0.07415,0.34239,0.25713]}, + {"t":0.21605, "x":6.00559, "y":2.08655, "heading":0.74476, "vx":1.84195, "vy":-0.77535, "omega":-3.83218, "ax":0.0027, "ay":0.00672, "alpha":-0.01144, "fx":[0.07405,0.02569,-0.01392,0.08543], "fy":[0.11695,0.15106,0.0946,0.06404]}, + {"t":0.22955, "x":6.03046, "y":2.07608, "heading":0.69301, "vx":1.84199, "vy":-0.77526, "omega":-3.83233, "ax":-0.00832, "ay":-0.02031, "alpha":0.03998, "fx":[-0.28138,-0.18386,0.01445,-0.07745], "fy":[-0.17211,-0.59091,-0.21514,-0.31182]}, + {"t":0.24306, "x":6.05533, "y":2.06561, "heading":0.64126, "vx":1.84188, "vy":-0.77554, "omega":-3.83179, "ax":-0.02019, "ay":-0.04707, "alpha":-0.01174, "fx":[-0.30245,-0.38115,-0.41726,-0.18141], "fy":[-0.63082,-0.7165,-0.8085,-0.83329]}, + {"t":0.25656, "x":6.0802, "y":2.05513, "heading":0.58952, "vx":1.84161, "vy":-0.77617, "omega":-3.83195, "ax":-0.04402, "ay":-0.1055, "alpha":0.04598, "fx":[-0.84682,-0.80278,-0.55709,-0.58881], "fy":[-1.45836,-2.0149,-1.54627,-1.67987]}, + {"t":0.27006, "x":6.10506, "y":2.04464, "heading":0.53778, "vx":1.84101, "vy":-0.7776, "omega":-3.83133, "ax":-0.06886, "ay":-0.16131, "alpha":-0.0088, "fx":[-1.09106,-1.23428,-1.27225,-0.77537], "fy":[-2.23099,-2.55291,-2.71701,-2.74305]}, + {"t":0.28356, "x":6.12992, "y":2.03413, "heading":0.48604, "vx":1.84008, "vy":-0.77978, "omega":-3.83145, "ax":-0.1166, "ay":-0.27608, "alpha":0.09648, "fx":[-2.10668,-2.07332,-1.60644,-1.61773], "fy":[-4.01909,-4.99931,-4.27759,-4.23611]}, + {"t":0.29707, "x":6.15475, "y":2.02357, "heading":0.43431, "vx":1.83851, "vy":-0.7835, "omega":-3.83014, "ax":-0.16281, "ay":-0.37875, "alpha":0.22412, "fx":[-3.38857,-3.18767,-2.13448,-1.62789], "fy":[-5.06504,-6.78992,-6.5548,-5.64228]}, + {"t":0.31057, "x":6.17956, "y":2.01296, "heading":0.38259, "vx":1.83631, "vy":-0.78862, "omega":-3.82712, "ax":-0.25339, "ay":-0.58834, "alpha":0.80328, "fx":[-6.62473,-5.47988,-1.43941,-2.54724], "fy":[-7.94881,-12.37907,-10.14284,-6.89041]}, + {"t":0.32407, "x":6.20434, "y":2.00226, "heading":0.33091, "vx":1.83289, "vy":-0.79656, "omega":-3.81627, "ax":-0.33412, "ay":-0.76157, "alpha":2.09144, "fx":[-12.43165,-9.48804,1.21276,-0.51083], "fy":[-7.95808,-18.71662,-15.50695,-6.1803]}, + {"t":0.33758, "x":6.22906, "y":1.99143, "heading":0.27938, "vx":1.82838, "vy":-0.80685, "omega":-3.78803, "ax":-0.4967, "ay":-1.11375, "alpha":4.61704, "fx":[-23.35851,-17.1782,7.3772,1.61746], "fy":[-10.10152,-31.77505,-25.19402,-3.65572]}, + {"t":0.35108, "x":6.2537, "y":1.98043, "heading":0.22823, "vx":1.82167, "vy":-0.82189, "omega":-3.72569, "ax":-0.62603, "ay":-1.36911, "alpha":8.60384, "fx":[-38.52768,-28.22925,17.30031,9.70204], "fy":[-5.69059,-46.57731,-37.76047,3.08569]}, + {"t":0.36458, "x":6.27824, "y":1.96921, "heading":0.17792, "vx":1.81321, "vy":-0.84037, "omega":-3.60951, "ax":-0.88018, "ay":-1.86271, "alpha":13.07176, "fx":[-57.92435,-42.60202,26.92473,17.70779], "fy":[-5.81462,-63.76865,-56.71807,8.01383]}, + {"t":0.37809, "x":6.30264, "y":1.95769, "heading":0.12918, "vx":1.80133, "vy":-0.86552, "omega":-3.433, "ax":-1.04736, "ay":-2.13714, "alpha":17.30986, "fx":[-75.32319,-54.61652,34.45311,28.97587], "fy":[0.52526,-76.28986,-73.5525,13.60251]}, + {"t":0.39159, "x":6.32687, "y":1.94581, "heading":0.08282, "vx":1.78719, "vy":-0.89438, "omega":-3.19926, "ax":-1.35234, "ay":-2.63065, "alpha":19.60931, "fx":[-91.0583,-63.88739,32.80967,36.25818], "fy":[-3.45502,-83.63853,-90.77235,10.81178]}, + {"t":0.40509, "x":6.35088, "y":1.9335, "heading":0.03962, "vx":1.76893, "vy":-0.9299, "omega":-2.93448, "ax":-1.58873, "ay":-2.81929, "alpha":21.21365, "fx":[-101.30221,-71.2722,28.83242,42.85321], "fy":[0.27892,-86.19518,-101.18984,8.07293]}, + {"t":0.4186, "x":6.37462, "y":1.92068, "heading":0.0, "vx":1.74747, "vy":-0.96797, "omega":-2.64803, "ax":-1.51522, "ay":-2.76229, "alpha":23.3199, "fx":[-107.64331,-77.05817,29.47234,59.00819], "fy":[6.21658,-86.34402,-106.23983,10.9538]}, + {"t":0.43977, "x":6.41128, "y":1.89957, "heading":-0.05606, "vx":1.7154, "vy":-1.02645, "omega":-2.15432, "ax":-1.00017, "ay":-1.63411, "alpha":25.65442, "fx":[-95.42784,-80.49702,43.20719,69.20417], "fy":[36.13224,-76.98563,-96.68708,33.76989]}, + {"t":0.46094, "x":6.44737, "y":1.87747, "heading":-0.10167, "vx":1.69422, "vy":-1.06105, "omega":-1.6112, "ax":0.11681, "ay":0.18695, "alpha":26.50099, "fx":[-64.32717,-78.61169,69.75501,80.60139], "fy":[74.32913,-53.83591,-67.78649,59.16505]}, + {"t":0.48211, "x":6.48327, "y":1.85505, "heading":-0.13578, "vx":1.69669, "vy":-1.05709, "omega":-1.05015, "ax":1.28401, "ay":2.12328, "alpha":23.36043, "fx":[-28.95002,-62.97667,91.86525,81.59963], "fy":[100.6082,-12.92026,-27.08969,74.23654]}, + {"t":0.50328, "x":6.51947, "y":1.83315, "heading":-0.15801, "vx":1.72388, "vy":-1.01214, "omega":-0.55558, "ax":1.79879, "ay":3.20607, "alpha":19.36196, "fx":[-11.24169,-47.40408,96.05299,76.8211], "fy":[105.02384,19.45236,0.70878,78.40994]}, + {"t":0.52445, "x":6.55637, "y":1.81244, "heading":-0.16978, "vx":1.76196, "vy":-0.94426, "omega":-0.14567, "ax":1.74366, "ay":3.42011, "alpha":18.01972, "fx":[-10.68999,-43.98564,91.3153,74.08779], "fy":[103.2224,30.23013,5.77578,77.9584]}, + {"t":0.54562, "x":6.59407, "y":1.79321, "heading":-0.17286, "vx":1.79887, "vy":-0.87186, "omega":0.23582, "ax":1.62828, "ay":3.54631, "alpha":16.89847, "fx":[-10.87969,-41.42984,85.91145,69.79862], "fy":[101.24991,33.13578,11.97553,78.83986]}, + {"t":0.56679, "x":6.63251, "y":1.77555, "heading":-0.16787, "vx":1.83335, "vy":-0.79678, "omega":0.59358, "ax":1.49166, "ay":3.64037, "alpha":15.6725, "fx":[-12.2536,-37.77605,79.34109,65.41332], "fy":[98.41151,37.81898,16.16996,78.7734]}, + {"t":0.58796, "x":6.67166, "y":1.7595, "heading":-0.1553, "vx":1.86493, "vy":-0.71971, "omega":0.92538, "ax":1.34436, "ay":3.71676, "alpha":14.47963, "fx":[-13.20246,-34.63335,72.82252,60.38415], "fy":[95.70391,38.97839,22.16558,79.17713]}, + {"t":0.60913, "x":6.71145, "y":1.74509, "heading":-0.13571, "vx":1.89339, "vy":-0.64102, "omega":1.23192, "ax":1.19063, "ay":3.78094, "alpha":13.05551, "fx":[-14.13714,-30.12465,65.38843,54.48202], "fy":[92.06408,41.66169,27.20648,79.16823]}, + {"t":0.6303, "x":6.7518, "y":1.73237, "heading":-0.10963, "vx":1.91859, "vy":-0.56098, "omega":1.50832, "ax":1.03244, "ay":3.83519, "alpha":11.83582, "fx":[-14.98225,-27.07206,58.67085,48.94668], "fy":[89.0338,42.69508,32.73906,79.0778]}, + {"t":0.65148, "x":6.79265, "y":1.72135, "heading":-0.0777, "vx":1.94045, "vy":-0.47978, "omega":1.7589, "ax":0.87098, "ay":3.88066, "alpha":10.38197, "fx":[-15.20341,-22.85897,51.23104,42.14096], "fy":[85.26024,44.5324,37.7881,78.85257]}, + {"t":0.67265, "x":6.83392, "y":1.71207, "heading":-0.04046, "vx":1.95889, "vy":-0.39762, "omega":1.97869, "ax":0.70697, "ay":3.91793, "alpha":9.20198, "fx":[-15.7818,-20.34893,44.58606,36.43905], "fy":[82.17307,45.83195,42.54999,78.24516]}, + {"t":0.69382, "x":6.87555, "y":1.70453, "heading":0.00143, "vx":1.97386, "vy":-0.31468, "omega":2.17351, "ax":0.54087, "ay":3.94734, "alpha":7.86839, "fx":[-15.58501,-17.21587,37.58766,29.55988], "fy":[78.65825,47.51824,46.88095,77.61044]}, + {"t":0.71499, "x":6.91746, "y":1.69875, "heading":0.04745, "vx":1.98531, "vy":-0.23111, "omega":2.34009, "ax":0.3714, "ay":3.96922, "alpha":6.79367, "fx":[-15.9023,-15.58717,31.05427,24.01999], "fy":[75.8766,48.98282,50.63883,76.55908]}, + {"t":0.73616, "x":6.95958, "y":1.69474, "heading":0.09699, "vx":1.99317, "vy":-0.14708, "omega":2.48391, "ax":0.17908, "ay":3.98438, "alpha":5.67611, "fx":[-16.03643,-14.24529,24.34329,17.31077], "fy":[72.84069,50.62259,53.94331,75.61345]}, + {"t":0.75733, "x":7.00181, "y":1.69252, "heading":0.14958, "vx":1.99696, "vy":-0.06272, "omega":2.60408, "ax":-0.15474, "ay":3.98691, "alpha":4.75383, "fx":[-18.7005,-16.23475,15.39904,9.7098], "fy":[70.44443,51.86931,56.58456,74.282]}, + {"t":0.7785, "x":7.04406, "y":1.69209, "heading":0.20471, "vx":1.99369, "vy":0.02168, "omega":2.70473, "ax":-0.64693, "ay":3.93843, "alpha":3.89688, "fx":[-23.78525,-21.04528,4.57658,-0.82787], "fy":[67.2797,52.38625,58.00969,72.4262]}, + {"t":0.79967, "x":7.08612, "y":1.69343, "heading":0.26197, "vx":1.97999, "vy":0.10506, "omega":2.78723, "ax":-1.07892, "ay":3.84378, "alpha":3.10386, "fx":[-28.09592,-25.26104,-5.49327,-9.66446], "fy":[64.12532,52.47261,58.04927,69.44383]}, + {"t":0.82084, "x":7.1278, "y":1.69652, "heading":0.32098, "vx":1.95715, "vy":0.18644, "omega":2.85294, "ax":-1.41647, "ay":3.7336, "alpha":2.47859, "fx":[-31.27332,-28.52971,-13.08655,-17.06035], "fy":[61.2422,51.90413,57.52885,66.41921]}, + {"t":0.84201, "x":7.16891, "y":1.7013, "heading":0.38138, "vx":1.92716, "vy":0.26548, "omega":2.90541, "ax":-1.67656, "ay":3.62511, "alpha":1.81181, "fx":[-33.22477,-30.64689,-19.80134,-22.79318], "fy":[58.55075,52.04823,56.54896,63.05716]}, + {"t":0.86318, "x":7.20934, "y":1.70773, "heading":0.44289, "vx":1.89167, "vy":0.34223, "omega":2.94377, "ax":-1.87903, "ay":3.52513, "alpha":1.33362, "fx":[-34.6869,-32.53811,-24.77103,-27.3276], "fy":[56.46775,51.65071,55.58459,60.15321]}, + {"t":0.88436, "x":7.24897, "y":1.71577, "heading":0.50521, "vx":1.85189, "vy":0.41686, "omega":2.972, "ax":-2.03914, "ay":3.43561, "alpha":0.75205, "fx":[-35.25327,-33.65529,-29.48837,-31.09421], "fy":[54.62495,52.20502,54.33266,57.00847]}, + {"t":0.90553, "x":7.28771, "y":1.72536, "heading":0.56813, "vx":1.80872, "vy":0.48959, "omega":2.98793, "ax":-2.16793, "ay":3.35635, "alpha":0.33405, "fx":[-35.60218,-34.91326,-33.10688,-34.04732], "fy":[53.42408,52.0835,53.26529,54.36492]}, + {"t":0.9267, "x":7.32552, "y":1.73648, "heading":0.63139, "vx":1.76282, "vy":0.56065, "omega":2.995, "ax":-2.27321, "ay":3.2864, "alpha":-0.19791, "fx":[-35.37476,-35.70919,-36.81147,-36.45982], "fy":[52.31204,52.91264,51.94549,51.526]}, + {"t":0.94787, "x":7.36233, "y":1.74909, "heading":0.69479, "vx":1.71469, "vy":0.63023, "omega":2.99081, "ax":-2.36054, "ay":3.22463, "alpha":-0.64296, "fx":[-34.9592,-36.67721,-39.90008,-38.36478], "fy":[51.77427,53.3142,50.72187,48.96337]}, + {"t":0.96904, "x":7.3981, "y":1.76315, "heading":0.75811, "vx":1.66472, "vy":0.6985, "omega":2.9772, "ax":-2.43397, "ay":3.16992, "alpha":-1.20266, "fx":[-34.00426,-37.42284,-43.18524,-39.95175], "fy":[51.44984,54.43837,49.23539,46.17552]}, + {"t":0.99021, "x":7.4328, "y":1.77865, "heading":0.82114, "vx":1.61319, "vy":0.76561, "omega":2.95173, "ax":-2.49643, "ay":3.12127, "alpha":-1.74469, "fx":[-32.85535,-38.37441,-46.22748,-41.07307], "fy":[51.62506,55.40094,47.71675,43.46703]}, + {"t":1.01138, "x":7.4664, "y":1.79556, "heading":0.88363, "vx":1.56034, "vy":0.83169, "omega":2.9148, "ax":-2.55013, "ay":3.07782, "alpha":-2.40323, "fx":[-31.16423,-39.26947,-49.50363,-42.00327], "fy":[52.16597,56.88806,45.90302,40.49335]}, + {"t":1.03255, "x":7.49886, "y":1.81386, "heading":0.94534, "vx":1.50635, "vy":0.89685, "omega":2.86392, "ax":-2.59672, "ay":3.03885, "alpha":-3.10311, "fx":[-29.24599,-40.45032,-52.77074,-42.43255], "fy":[53.23397,58.41477,43.90245,37.42447]}, + {"t":1.05372, "x":7.53017, "y":1.83352, "heading":1.00597, "vx":1.45137, "vy":0.96118, "omega":2.79822, "ax":-2.63751, "ay":3.00373, "alpha":-3.91483, "fx":[-26.8536,-41.69801,-56.29732,-42.64092], "fy":[54.77386,60.28964,41.56433,34.11766]}, + {"t":1.07489, "x":7.5603, "y":1.85455, "heading":1.06521, "vx":1.39554, "vy":1.02477, "omega":2.71534, "ax":-2.67347, "ay":2.97196, "alpha":-4.79607, "fx":[-24.27203,-43.32519,-59.86541,-42.31062], "fy":[56.82913,62.28954,38.96252,30.64716]}, + {"t":1.09606, "x":7.58925, "y":1.87691, "heading":1.1227, "vx":1.33894, "vy":1.08769, "omega":2.61381, "ax":-2.7054, "ay":2.9431, "alpha":-5.78309, "fx":[-21.30389,-45.15034,-63.71997,-41.62657], "fy":[59.60135,64.35166,35.94006,27.00268]}, + {"t":1.11724, "x":7.61699, "y":1.90059, "heading":1.17804, "vx":1.28166, "vy":1.15, "omega":2.49137, "ax":-2.74017, "ay":2.90883, "alpha":-5.12532, "fx":[-24.7825,-46.35519,-61.73738,-41.13404], "fy":[58.27801,61.6006,35.6668,29.1738]}, + {"t":1.14388, "x":7.65016, "y":1.93227, "heading":1.24442, "vx":1.20865, "vy":1.2275, "omega":2.35481, "ax":-2.78789, "ay":2.86561, "alpha":-4.38728, "fx":[-28.66522,-47.60717,-59.55512,-41.21163], "fy":[56.50409,58.48272,35.53506,31.45258]}, + {"t":1.17052, "x":7.68138, "y":1.96599, "heading":1.30716, "vx":1.13437, "vy":1.30386, "omega":2.23792, "ax":-2.83921, "ay":2.81459, "alpha":-3.81801, "fx":[-31.96825,-48.72826,-58.13593,-41.46569], "fy":[54.97273,55.60801,35.17438,32.97973]}, + {"t":1.19717, "x":7.7106, "y":2.00173, "heading":1.36679, "vx":1.05872, "vy":1.37885, "omega":2.13619, "ax":-2.89614, "ay":2.75578, "alpha":-3.30589, "fx":[-34.9718,-49.77483,-56.91813,-42.24848], "fy":[53.17519,52.93414,34.91083,33.97983]}, + {"t":1.22381, "x":7.73778, "y":2.03945, "heading":1.4237, "vx":0.98155, "vy":1.45227, "omega":2.04811, "ax":-2.95952, "ay":2.68736, "alpha":-2.89226, "fx":[-37.77063,-50.77489,-56.28762,-43.10485], "fy":[51.30667,50.45462,34.39009,34.50413]}, + {"t":1.25046, "x":7.76288, "y":2.0791, "heading":1.47827, "vx":0.9027, "vy":1.52388, "omega":1.97104, "ax":-3.03029, "ay":2.60703, "alpha":-2.51483, "fx":[-40.38471,-51.83657,-55.85708,-44.35387], "fy":[49.27736,47.9051,33.79983,34.57145]}, + {"t":1.2771, "x":7.78585, "y":2.12062, "heading":1.53079, "vx":0.82196, "vy":1.59334, "omega":1.90404, "ax":-3.10953, "ay":2.51166, "alpha":-2.21347, "fx":[-42.91116,-52.95843,-55.91838,-45.67615], "fy":[47.09299,45.40987,32.84098,34.1538]}, + {"t":1.30374, "x":7.80665, "y":2.16397, "heading":1.58152, "vx":0.73911, "vy":1.66026, "omega":1.84506, "ax":-3.19833, "ay":2.39716, "alpha":-1.93912, "fx":[-45.361,-54.18513,-56.19128,-47.36589], "fy":[44.69447,42.69183,31.62407,33.21639]}, + {"t":1.33039, "x":7.82521, "y":2.20906, "heading":1.63068, "vx":0.65389, "vy":1.72413, "omega":1.79339, "ax":-3.29776, "ay":2.25794, "alpha":-1.71373, "fx":[-47.89451,-55.56495,-56.8974,-49.06031], "fy":[41.84903,39.84486,29.91699,31.77501]}, + {"t":1.35703, "x":7.84146, "y":2.2558, "heading":1.67847, "vx":0.56603, "vy":1.78429, "omega":1.74773, "ax":-3.40845, "ay":2.08648, "alpha":-1.51917, "fx":[-50.35016,-57.1051,-57.8124,-51.17896], "fy":[38.80479,36.43078,27.68332,29.57859]}, + {"t":1.38368, "x":7.85533, "y":2.30408, "heading":1.72503, "vx":0.47521, "vy":1.83988, "omega":1.70726, "ax":-3.53004, "ay":1.87262, "alpha":-1.34132, "fx":[-53.05027,-58.81674,-59.10002,-53.20117], "fy":[34.71841,32.68793,24.74979,26.76084]}, + {"t":1.41032, "x":7.86674, "y":2.35376, "heading":1.77052, "vx":0.38116, "vy":1.88978, "omega":1.67152, "ax":-3.65992, "ay":1.60293, "alpha":-1.18934, "fx":[-55.6679,-60.68169,-60.53496,-55.5313], "fy":[30.09408,27.90502,20.91398,22.87781]}, + {"t":1.43697, "x":7.8756, "y":2.40468, "heading":1.81506, "vx":0.28364, "vy":1.93249, "omega":1.63983, "ax":-3.79073, "ay":1.26125, "alpha":-1.06338, "fx":[-58.2932,-62.56355,-62.11187,-57.75399], "fy":[24.16833,22.29923,15.85823,17.76704]}, + {"t":1.46361, "x":7.88181, "y":2.45662, "heading":1.85875, "vx":0.18264, "vy":1.96609, "omega":1.6115, "ax":-3.90669, "ay":0.83287, "alpha":-0.95518, "fx":[-60.57306,-64.25607,-63.48752,-59.76942], "fy":[17.12705,15.10808,9.4317,11.22265]}, + {"t":1.49025, "x":7.88529, "y":2.5093, "heading":1.90169, "vx":0.07855, "vy":1.98828, "omega":1.58605, "ax":-3.98043, "ay":0.32753, "alpha":-0.85711, "fx":[-62.14114,-65.29344,-64.26802,-61.06611], "fy":[8.62158,7.02396,1.75441,3.3989]}, + {"t":1.5169, "x":7.88597, "y":2.5624, "heading":1.94395, "vx":-0.02751, "vy":1.99701, "omega":1.56321, "ax":-3.99176, "ay":-0.10986, "alpha":-0.78225, "fx":[-62.62823,-65.36903,-64.14632,-61.34519], "fy":[1.5103,-0.25002,-4.87907,-3.35777]}, + {"t":1.54354, "x":7.88382, "y":2.61556, "heading":1.9856, "vx":-0.13387, "vy":1.99408, "omega":1.54237, "ax":-3.97581, "ay":-0.36645, "alpha":-0.70637, "fx":[-62.57828,-65.0146,-63.67613,-61.20645], "fy":[-2.96861,-4.40926,-8.67156,-7.22121]}, + {"t":1.57019, "x":7.87884, "y":2.66857, "heading":2.02669, "vx":-0.2398, "vy":1.98432, "omega":1.52355, "ax":-3.94941, "ay":-0.58174, "alpha":-0.66328, "fx":[-62.3661,-64.53002,-63.12278,-60.7799], "fy":[-6.50427,-8.07303,-11.87582,-10.48933]}, + {"t":1.59683, "x":7.87105, "y":2.72123, "heading":2.06729, "vx":-0.34503, "vy":1.96882, "omega":1.50587, "ax":-3.91209, "ay":-0.79161, "alpha":-0.60619, "fx":[-61.86861,-63.84428,-62.3616,-60.35457], "fy":[-10.09766,-11.4986,-15.02448,-13.64854]}, + {"t":1.62348, "x":7.86047, "y":2.77341, "heading":2.10741, "vx":-0.44926, "vy":1.94773, "omega":1.48972, "ax":-3.86374, "ay":-0.9988, "alpha":-0.59359, "fx":[-61.29021,-63.0894,-61.54443,-59.43484], "fy":[-13.4689,-14.92318,-18.17385,-16.86073]}, + {"t":1.65012, "x":7.84713, "y":2.82495, "heading":2.1471, "vx":-0.55221, "vy":1.92112, "omega":1.47391, "ax":-3.80447, "ay":-1.20316, "alpha":-0.5504, "fx":[-60.38365,-62.061,-60.4359,-58.71441], "fy":[-16.82758,-18.31565,-21.31298,-19.94797]}, + {"t":1.67676, "x":7.83106, "y":2.87571, "heading":2.18637, "vx":-0.65357, "vy":1.88906, "omega":1.45924, "ax":-3.73291, "ay":-1.40828, "alpha":-0.54313, "fx":[-59.36629,-60.98111,-59.24235,-57.46082], "fy":[-20.24658,-21.5397,-24.48496,-23.15878]}, + {"t":1.70341, "x":7.81232, "y":2.92554, "heading":2.22525, "vx":-0.75304, "vy":1.85154, "omega":1.44477, "ax":-3.60164, "ay":-1.71567, "alpha":-0.53519, "fx":[-57.38451,-58.88521,-57.01812,-55.42697], "fy":[-25.00487,-26.72633,-29.30003,-27.91885]}, + {"t":1.73005, "x":7.79098, "y":2.97426, "heading":2.26375, "vx":-0.849, "vy":1.80582, "omega":1.43051, "ax":-3.04447, "ay":-2.57842, "alpha":-0.56162, "fx":[-48.70472,-50.34271,-48.07859,-46.20655], "fy":[-38.93991,-40.19189,-42.91284,-41.69287]}, + {"t":1.7567, "x":7.76728, "y":3.02146, "heading":2.30186, "vx":-0.93012, "vy":1.73712, "omega":1.41555, "ax":-2.23455, "ay":-3.30634, "alpha":-0.57228, "fx":[-35.90525,-37.69424,-35.08517,-33.21591], "fy":[-50.5224,-51.97792,-54.36647,-53.09575]}, + {"t":1.78334, "x":7.7417, "y":3.06657, "heading":2.33958, "vx":-0.98965, "vy":1.64903, "omega":1.4003, "ax":-1.47469, "ay":-3.70955, "alpha":-0.60829, "fx":[-23.84988,-25.92987,-22.9924,-20.87475], "fy":[-56.96643,-58.44132,-60.77776,-59.38211]}, + {"t":1.80999, "x":7.71481, "y":3.10919, "heading":2.37689, "vx":-1.02895, "vy":1.55019, "omega":1.38409, "ax":-0.86967, "ay":-3.89727, "alpha":-0.65607, "fx":[-14.28318,-16.62563,-13.36186,-10.95623], "fy":[-59.87185,-61.65997,-63.78959,-62.16681]}, + {"t":1.83663, "x":7.68709, "y":3.14911, "heading":2.41377, "vx":-1.05212, "vy":1.44635, "omega":1.36661, "ax":-0.4129, "ay":-3.97271, "alpha":-0.70578, "fx":[-7.02909,-9.67601,-6.01528,-3.49999], "fy":[-61.01208,-62.91893,-65.1425,-63.20543]}, + {"t":1.86327, "x":7.65891, "y":3.18624, "heading":2.45018, "vx":-1.06312, "vy":1.3405, "omega":1.3478, "ax":-0.06933, "ay":-3.9943, "alpha":-0.80897, "fx":[-1.72142,-4.66254,-0.50507,2.48629], "fy":[-61.03683,-63.57767,-65.67372,-63.36125]}, + {"t":1.88992, "x":7.63056, "y":3.22054, "heading":2.48609, "vx":-1.06497, "vy":1.23407, "omega":1.32625, "ax":0.19294, "ay":-3.99086, "alpha":-0.89085, "fx":[2.35175,-0.90926,3.84815,6.9616], "fy":[-60.83582,-63.56109,-65.89007,-63.14423]}, + {"t":1.91656, "x":7.60225, "y":3.252, "heading":2.52143, "vx":-1.05983, "vy":1.12774, "omega":1.30251, "ax":0.39723, "ay":-3.97623, "alpha":-1.04046, "fx":[5.36275,1.71697,7.22914,10.91616], "fy":[-60.15782,-63.69959,-65.96535,-62.6793]}, + {"t":1.94321, "x":7.57415, "y":3.28064, "heading":2.55613, "vx":-1.04924, "vy":1.0218, "omega":1.27479, "ax":0.55964, "ay":-3.95705, "alpha":-1.16463, "fx":[7.7084,3.72547,10.08468,14.02039], "fy":[-59.63353,-63.49198,-66.01607,-62.14246]}, + {"t":1.96985, "x":7.5464, "y":3.30646, "heading":2.5901, "vx":-1.03433, "vy":0.91636, "omega":1.24376, "ax":0.69123, "ay":-3.93653, "alpha":-1.35647, "fx":[9.47316,5.04127,12.42967,16.95114], "fy":[-58.76032,-63.55253,-66.13011,-61.53842]}, + {"t":1.9965, "x":7.51908, "y":3.32948, "heading":2.62324, "vx":-1.01591, "vy":0.81148, "omega":1.20762, "ax":0.79967, "ay":-3.91623, "alpha":-1.54489, "fx":[10.81192,5.97712,14.5453,19.44703], "fy":[-57.99016,-63.54468,-66.26609,-60.89117]}, + {"t":2.02314, "x":7.4923, "y":3.34971, "heading":2.65541, "vx":-0.99461, "vy":0.70713, "omega":1.16646, "ax":0.89037, "ay":-3.89685, "alpha":-1.782, "fx":[11.77431,6.46113,16.39859,21.9069], "fy":[-57.09451,-63.74427,-66.46888,-60.15402]}, + {"t":2.04978, "x":7.46611, "y":3.36717, "heading":2.68649, "vx":-0.97088, "vy":0.60331, "omega":1.11898, "ax":0.96723, "ay":-3.8787, "alpha":-2.01489, "fx":[12.45622,6.73284,18.20958,24.0234], "fy":[-56.29515,-63.86763,-66.72755,-59.4185]}, + {"t":2.07643, "x":7.44059, "y":3.38187, "heading":2.71631, "vx":-0.94511, "vy":0.49996, "omega":1.06529, "ax":1.03312, "ay":-3.86185, "alpha":-2.33292, "fx":[12.79636,6.55149,19.79744,26.46108], "fy":[-55.26645,-64.31472,-67.09314,-58.56469]}, + {"t":2.10307, "x":7.41577, "y":3.39382, "heading":2.74469, "vx":-0.91759, "vy":0.39706, "omega":1.00313, "ax":-1.30677, "ay":-3.77443, "alpha":-2.26185, "fx":[-26.10619,-29.15264,-15.89013,-11.83463], "fy":[-53.30438,-61.21984,-66.29751,-58.86563]}, + {"t":2.13948, "x":7.3815, "y":3.40577, "heading":2.78121, "vx":-0.96516, "vy":0.25965, "omega":0.92079, "ax":-0.76028, "ay":-3.91792, "alpha":-1.88549, "fx":[-16.57689,-19.23651,-7.92433,-4.54251], "fy":[-57.04513,-63.71942,-67.18303,-60.85175]}, + {"t":2.17588, "x":7.34586, "y":3.41263, "heading":2.81473, "vx":-0.99284, "vy":0.11701, "omega":0.85214, "ax":-0.07095, "ay":-0.66849, "alpha":-2.19957, "fx":[-5.31468,-8.63492,2.96204,6.48175], "fy":[-3.61341,-14.01881,-17.28079,-7.53778]}, + {"t":2.21229, "x":7.30967, "y":3.41644, "heading":2.84576, "vx":-0.99542, "vy":0.09268, "omega":0.77206, "ax":0.02079, "ay":0.2142, "alpha":-1.86859, "fx":[-3.2936,-5.95572,3.96469,6.60493], "fy":[9.26093,0.49444,-2.39393,6.24087]}, + {"t":2.2487, "x":7.27344, "y":3.41996, "heading":2.87386, "vx":-0.99467, "vy":0.10047, "omega":0.70404, "ax":0.01227, "ay":0.11889, "alpha":-1.53023, "fx":[-2.92174,-4.92003,3.32442,5.2966], "fy":[6.55231,-0.43468,-2.86288,4.2948]}, + {"t":2.2851, "x":7.23724, "y":3.4237, "heading":2.8995, "vx":-0.99422, "vy":0.1048, "omega":0.64833, "ax":0.0087, "ay":0.08133, "alpha":-1.26183, "fx":[-2.53621,-4.03302,2.81989,4.30159], "fy":[5.0628,-0.67784,-2.58625,3.36626]}, + {"t":2.32151, "x":7.20105, "y":3.42757, "heading":2.9231, "vx":-0.9939, "vy":0.10776, "omega":0.60239, "ax":0.00708, "ay":0.06461, "alpha":-1.04428, "fx":[-2.17569,-3.29691,2.40438,3.51803], "fy":[4.09598,-0.67851,-2.13581,2.82139]}, + {"t":2.35792, "x":7.16487, "y":3.43153, "heading":2.94503, "vx":-0.99364, "vy":0.11012, "omega":0.56437, "ax":0.00591, "ay":0.05282, "alpha":-0.86682, "fx":[-1.86121,-2.70083,2.05051,2.88654], "fy":[3.34827,-0.64551,-1.74079,2.39221]}, + {"t":2.39432, "x":7.1287, "y":3.43558, "heading":2.96558, "vx":-0.99343, "vy":0.11204, "omega":0.53281, "ax":0.00508, "ay":0.04472, "alpha":-0.72212, "fx":[-1.58997,-2.21825,1.75214,2.37872], "fy":[2.77043,-0.58664,-1.39864,2.05456]}, + {"t":2.43073, "x":7.09253, "y":3.43969, "heading":2.98497, "vx":-0.99324, "vy":0.11367, "omega":0.50652, "ax":0.00452, "ay":0.03923, "alpha":-0.60506, "fx":[-1.3602,-1.83032,1.50408,1.97336], "fy":[2.32524,-0.51482,-1.10886,1.78963]}, + {"t":2.46714, "x":7.05638, "y":3.44385, "heading":3.00341, "vx":-0.99308, "vy":0.1151, "omega":0.48449, "ax":0.00411, "ay":0.03522, "alpha":-0.51091, "fx":[-1.16883,-1.52064,1.2994,1.65076], "fy":[1.9773,-0.44475,-0.87262,1.57674]}, + {"t":2.50354, "x":7.02022, "y":3.44806, "heading":3.02105, "vx":-0.99293, "vy":0.11638, "omega":0.46589, "ax":0.00378, "ay":0.03209, "alpha":-0.43652, "fx":[-1.01398,-1.27778,1.13415,1.39769], "fy":[1.70513,-0.38467,-0.68751,1.40511]}, + {"t":2.53995, "x":6.98408, "y":3.45232, "heading":3.03801, "vx":-0.99279, "vy":0.11755, "omega":0.45, "ax":0.00352, "ay":0.02961, "alpha":-0.37879, "fx":[-0.89193,-1.09028,1.00386,1.20204], "fy":[1.49401,-0.33656,-0.54574,1.2688]}, + {"t":2.57636, "x":6.94794, "y":3.45662, "heading":3.0544, "vx":-0.99266, "vy":0.11862, "omega":0.43621, "ax":0.00332, "ay":0.02767, "alpha":-0.33592, "fx":[-0.80122,-0.95107,0.90671,1.05644], "fy":[1.33526,-0.30191,-0.44182,1.16547]}, + {"t":2.61276, "x":6.9118, "y":3.46096, "heading":3.07028, "vx":-0.99254, "vy":0.11963, "omega":0.42398, "ax":0.00317, "ay":0.02617, "alpha":-0.30609, "fx":[-0.73944,-0.85307,0.84005,0.95359], "fy":[1.22097,-0.28157,-0.36995,1.09255]}, + {"t":2.64917, "x":6.87567, "y":3.46533, "heading":3.08571, "vx":-0.99243, "vy":0.12058, "omega":0.41284, "ax":0.00306, "ay":0.02505, "alpha":-0.28845, "fx":[-0.7064,-0.79249,0.80345,0.88948], "fy":[1.14619,-0.27719,-0.32724,1.04917]}, + {"t":2.68557, "x":6.83954, "y":3.46974, "heading":3.10074, "vx":-0.99232, "vy":0.1215, "omega":0.40234, "ax":0.00298, "ay":0.02426, "alpha":-0.28223, "fx":[-0.7016,-0.7658,0.79628,0.86042], "fy":[1.10685,-0.29049,-0.31073,1.03474]}, + {"t":2.72198, "x":6.80341, "y":3.47418, "heading":3.11539, "vx":-0.99221, "vy":0.12238, "omega":0.39206, "ax":0.00294, "ay":0.02375, "alpha":-0.28732, "fx":[-0.72618,-0.77148,0.81955,0.8648], "fy":[1.10069,-0.32335,-0.31915,1.05]}, + {"t":2.75839, "x":6.76729, "y":3.47865, "heading":3.12966, "vx":-0.9921, "vy":0.12324, "omega":0.3816, "ax":0.00293, "ay":0.02351, "alpha":-0.30391, "fx":[-0.78183,-0.80891,0.87494,0.90196], "fy":[1.1268,-0.37855,-0.35175,1.0967]}, + {"t":2.79479, "x":6.73117, "y":3.48315, "heading":-3.13963, "vx":-0.99199, "vy":0.1241, "omega":0.37054, "ax":0.00296, "ay":0.02354, "alpha":-0.33257, "fx":[-0.87135,-0.87855,0.96522,0.97236], "fy":[1.18504,-0.45866,-0.40876,1.17736]}, + {"t":2.8312, "x":6.69506, "y":3.48768, "heading":-3.12614, "vx":-0.99189, "vy":0.12496, "omega":0.35843, "ax":0.00301, "ay":0.02383, "alpha":-0.37443, "fx":[-0.99895,-0.98236,1.09467,1.07799], "fy":[1.27698,-0.568,-0.49156,1.2961]}, + {"t":2.86761, "x":6.65895, "y":3.49225, "heading":-3.11309, "vx":-0.99178, "vy":0.12582, "omega":0.3448, "ax":0.00311, "ay":0.0244, "alpha":-0.4309, "fx":[-1.16974,-1.12302,1.26845,1.2216], "fy":[1.4046,-0.71067,-0.60212,1.45769]}, + {"t":2.90401, "x":6.62285, "y":3.49685, "heading":-3.10054, "vx":-0.99166, "vy":0.12671, "omega":0.32911, "ax":0.00324, "ay":0.02526, "alpha":-0.5041, "fx":[-1.39082,-1.30499,1.49379,1.40777], "fy":[1.57182,-0.89276,-0.74383,1.66904]}, + {"t":2.94042, "x":6.58675, "y":3.50148, "heading":-3.08855, "vx":-0.99155, "vy":0.12763, "omega":0.31076, "ax":0.00342, "ay":0.02646, "alpha":-0.59656, "fx":[-1.67064,-1.53385,1.77934,1.64226], "fy":[1.78349,-1.12073,-0.92084,1.9383]}, + {"t":2.97683, "x":6.55065, "y":3.50614, "heading":-3.07724, "vx":-0.99142, "vy":0.1286, "omega":0.28904, "ax":0.00365, "ay":0.02804, "alpha":-0.71156, "fx":[-2.01968,-1.81691,2.13588,1.93263], "fy":[2.04631,-1.40269,-1.13861,2.27581]}, + {"t":3.01323, "x":6.51456, "y":3.51084, "heading":-3.06672, "vx":-0.99129, "vy":0.12962, "omega":0.26313, "ax":0.00395, "ay":0.03009, "alpha":-0.85324, "fx":[-2.45105,-2.16382,2.57691,2.28885], "fy":[2.3692,-1.74867,-1.40439,2.69444]}, + {"t":3.04964, "x":6.47847, "y":3.51558, "heading":-3.05714, "vx":-0.99115, "vy":0.13071, "omega":0.23207, "ax":0.00433, "ay":0.03268, "alpha":-1.02635, "fx":[-2.97953,-2.58585,3.11772,2.72258], "fy":[2.76263,-2.16964,-1.7267,3.20873]}, + {"t":3.08604, "x":6.44239, "y":3.52036, "heading":-3.04869, "vx":-0.99099, "vy":0.1319, "omega":0.1947, "ax":0.00481, "ay":0.03596, "alpha":-1.23726, "fx":[-3.62418,-3.09861,3.77826,3.24997], "fy":[3.24207,-2.68016,-2.11684,3.83823]}, + {"t":3.12245, "x":6.40632, "y":3.52519, "heading":-3.0416, "vx":-0.99081, "vy":0.13321, "omega":0.14966, "ax":0.00544, "ay":0.04027, "alpha":-1.49285, "fx":[-4.40466,-3.71929,4.58028,3.88945], "fy":[3.82773,-3.29181,-2.5847,4.60628]}, + {"t":3.15886, "x":6.37025, "y":3.53006, "heading":-3.03615, "vx":-0.99061, "vy":0.13468, "omega":0.09531, "ax":0.00634, "ay":0.04637, "alpha":-1.80243, "fx":[-5.34563,-4.47159,5.55286,4.66725], "fy":[4.5532,-4.01704,-3.13948,5.54798]}, + {"t":3.19526, "x":6.33419, "y":3.535, "heading":-3.03268, "vx":-0.99038, "vy":0.13637, "omega":0.02969, "ax":0.00765, "ay":0.05515, "alpha":-2.17579, "fx":[-6.47109,-5.38233,6.72652,5.61277], "fy":[5.45788,-4.86517,-3.79014,6.69993]}, + {"t":3.23167, "x":6.29814, "y":3.54, "heading":-3.0316, "vx":-0.9901, "vy":0.13837, "omega":-0.04952, "ax":0.00941, "ay":0.06677, "alpha":-2.62585, "fx":[-7.81218,-6.49061,8.13741,6.76321], "fy":[6.58101,-5.86772,-4.56505,8.09155]}, + {"t":3.26808, "x":6.2621, "y":3.54508, "heading":-3.0334, "vx":-0.98976, "vy":0.1408, "omega":-0.14512, "ax":0.01217, "ay":0.0846, "alpha":-3.16763, "fx":[-9.39185,-7.83478,9.82899,8.1704], "fy":[8.02787,-7.01579,-5.44644,9.80666]}, + {"t":3.30448, "x":6.22607, "y":3.55026, "heading":-3.03869, "vx":-0.98932, "vy":0.14388, "omega":-0.26044, "ax":0.0215, "ay":0.14509, "alpha":-3.82497, "fx":[-11.15942,-9.385,11.91985,9.98964], "fy":[10.46956,-7.84072,-5.90448,12.48917]}, + {"t":3.34089, "x":6.19007, "y":3.5556, "heading":-3.04817, "vx":-0.98854, "vy":0.14917, "omega":-0.39969, "ax":0.03664, "ay":0.23523, "alpha":-4.62151, "fx":[-13.16128,-11.14517,14.29945,12.33399], "fy":[13.80676,-8.80349,-6.11848,16.05326]}, + {"t":3.3773, "x":6.1541, "y":3.56118, "heading":-3.06272, "vx":-0.9872, "vy":0.15773, "omega":-0.56795, "ax":2.98354, "ay":-1.62637, "alpha":-4.10304, "fx":[37.02077,36.15418,57.31094,58.97775], "fy":[-17.4489,-39.42436,-33.27144,-13.13425]}, + {"t":3.4137, "x":6.12014, "y":3.56585, "heading":-3.0834, "vx":-0.87858, "vy":0.09852, "omega":-0.71732, "ax":1.68179, "ay":-3.62493, "alpha":-4.49988, "fx":[13.03798,12.45802,38.79489,42.50754], "fy":[-51.05937,-69.32935,-64.09276,-45.71224]}, + {"t":3.45011, "x":6.08927, "y":3.56703, "heading":-3.10951, "vx":-0.81735, "vy":-0.03345, "omega":-0.88115, "ax":1.07704, "ay":-3.85077, "alpha":-5.31926, "fx":[-0.31699,0.38725,31.93303,36.39218], "fy":[-53.03795,-73.3002,-69.43057,-48.76649]}, + {"t":3.48652, "x":6.06022, "y":3.56326, "heading":3.14159, "vx":-0.77814, "vy":-0.17364, "omega":-1.0748, "ax":0.99093, "ay":-3.8714, "alpha":-3.24687, "fx":[5.62503,4.98467,24.83952,27.47751], "fy":[-56.17028,-68.66984,-66.75377,-54.25141]}, + {"t":3.50799, "x":6.04374, "y":3.55864, "heading":3.11851, "vx":-0.75686, "vy":-0.25679, "omega":-1.14454, "ax":0.9947, "ay":-3.8723, "alpha":-2.91717, "fx":[6.94117,5.87945,23.7903,26.5554], "fy":[-56.6395,-67.75842,-66.39675,-55.10757]}, + {"t":3.52947, "x":6.02771, "y":3.55223, "heading":3.09392, "vx":-0.7355, "vy":-0.33997, "omega":-1.2072, "ax":0.99833, "ay":-3.87126, "alpha":-2.64276, "fx":[8.12509,6.67633,22.96408,25.63141], "fy":[-56.82184,-67.11556,-66.05642,-55.84257]}, + {"t":3.55095, "x":6.01215, "y":3.54403, "heading":3.068, "vx":-0.71405, "vy":-0.42311, "omega":-1.26396, "ax":1.00234, "ay":-3.87011, "alpha":-2.38849, "fx":[9.13334,7.43634,22.15202,24.92976], "fy":[-57.14896,-66.3774,-65.75917,-56.4779]}, + {"t":3.57243, "x":5.99704, "y":3.53405, "heading":3.04085, "vx":-0.69252, "vy":-0.50624, "omega":-1.31526, "ax":1.00679, "ay":-3.86883, "alpha":-2.16825, "fx":[10.07905,8.12969,21.50561,24.21967], "fy":[-57.32422,-65.83976,-65.46679,-57.05133]}, + {"t":3.59391, "x":5.9824, "y":3.52229, "heading":3.0126, "vx":-0.6709, "vy":-0.58933, "omega":-1.36183, "ax":1.01175, "ay":-3.86739, "alpha":-1.96481, "fx":[10.9102,8.80194,20.88055,23.65671], "fy":[-57.56568,-65.25557,-65.21282,-57.55684]}, + {"t":3.61539, "x":5.96822, "y":3.50874, "heading":2.98335, "vx":-0.64917, "vy":-0.6724, "omega":-1.40403, "ax":1.01733, "ay":-3.86577, "alpha":-1.79338, "fx":[11.66687,9.39601,20.40098,23.13974], "fy":[-57.72073,-64.82951,-64.95811,-57.9796]}, + {"t":3.63686, "x":5.95451, "y":3.49341, "heading":2.95319, "vx":-0.62732, "vy":-0.75543, "omega":-1.44255, "ax":1.02364, "ay":-3.86393, "alpha":-1.63658, "fx":[12.36258,9.98085,19.9421,22.71887], "fy":[-57.86268,-64.36876,-64.76057,-58.37877]}, + {"t":3.65834, "x":5.94128, "y":3.47629, "heading":2.92221, "vx":-0.60533, "vy":-0.83842, "omega":-1.4777, "ax":1.03084, "ay":-3.86181, "alpha":-1.51462, "fx":[12.96362,10.45267,19.64558,22.39952], "fy":[-57.9847,-64.11473,-64.50551,-58.63135]}, + {"t":3.67982, "x":5.92851, "y":3.45739, "heading":2.89047, "vx":-0.58319, "vy":-0.92137, "omega":-1.51023, "ax":1.03913, "ay":-3.85935, "alpha":-1.37952, "fx":[13.50014,11.01872,19.35582,22.11304], "fy":[-58.25871,-63.59766,-64.32245,-58.90141]}, + {"t":3.7013, "x":5.91623, "y":3.43671, "heading":2.85803, "vx":-0.56087, "vy":-1.00426, "omega":-1.53986, "ax":1.04876, "ay":-3.85647, "alpha":-1.30216, "fx":[14.0457,11.41075,19.17859,21.96448], "fy":[-58.18116,-63.43099,-64.16429,-59.1208]}, + {"t":3.72278, "x":5.90442, "y":3.41425, "heading":2.82496, "vx":-0.53835, "vy":-1.08709, "omega":-1.56783, "ax":1.06012, "ay":-3.85304, "alpha":-1.20709, "fx":[14.5475,11.9046,19.04714,21.82131], "fy":[-58.3157,-63.03263,-64.02597,-59.30511]}, + {"t":3.74426, "x":5.8931, "y":3.39001, "heading":2.79128, "vx":-0.51558, "vy":-1.16985, "omega":-1.59376, "ax":1.07369, "ay":-3.84889, "alpha":-1.1667, "fx":[15.03287,12.22738,19.02204,21.9], "fy":[-58.20214,-62.9284,-63.88593,-59.39951]}, + {"t":3.76573, "x":5.88228, "y":3.364, "heading":2.75705, "vx":-0.49252, "vy":-1.25251, "omega":-1.61882, "ax":1.09021, "ay":-3.84377, "alpha":-1.09803, "fx":[15.48851,12.7033,19.05787,21.98191], "fy":[-58.36919,-62.50486,-63.75841,-59.45819]}, + {"t":3.78721, "x":5.87195, "y":3.33621, "heading":2.72228, "vx":-0.4691, "vy":-1.33507, "omega":-1.6424, "ax":1.11071, "ay":-3.8373, "alpha":-1.09685, "fx":[16.05578,13.00663,19.19625,22.27475], "fy":[-58.03951,-62.43878,-63.69104,-59.51064]}, + {"t":3.80869, "x":5.86213, "y":3.30665, "heading":2.68701, "vx":-0.44524, "vy":-1.41749, "omega":-1.66596, "ax":1.13691, "ay":-3.82886, "alpha":-1.0608, "fx":[16.64746,13.53067,19.45395,22.56522], "fy":[-57.99788,-62.04879,-63.59711,-59.50004]}, + {"t":3.83017, "x":5.85283, "y":3.27532, "heading":2.65123, "vx":-0.42083, "vy":-1.49973, "omega":-1.68874, "ax":1.17147, "ay":-3.81742, "alpha":-1.09676, "fx":[17.36058,13.90506,19.83769,23.28821], "fy":[-57.55971,-61.96258,-63.51109,-59.38373]}, + {"t":3.85165, "x":5.84406, "y":3.24223, "heading":2.61495, "vx":-0.39566, "vy":-1.58172, "omega":-1.7123, "ax":1.21928, "ay":-3.801, "alpha":-1.0986, "fx":[18.33356,14.65405,20.47953,23.96069], "fy":[-57.15394,-61.49246,-63.43547,-59.29276]}, + {"t":3.87313, "x":5.83584, "y":3.20738, "heading":2.57818, "vx":-0.36948, "vy":-1.66336, "omega":-1.7359, "ax":1.28943, "ay":-3.77567, "alpha":-1.16365, "fx":[19.54103,15.46037,21.40252,25.47863], "fy":[-56.58706,-60.9936,-63.26714,-58.91814]}, + {"t":3.8946, "x":5.82821, "y":3.17078, "heading":2.54089, "vx":-0.34178, "vy":-1.74445, "omega":-1.76089, "ax":1.40285, "ay":-3.73152, "alpha":-1.19535, "fx":[21.59374,17.09937,23.13544,27.25628], "fy":[-55.64379,-60.24858,-62.78706,-58.28321]}, + {"t":3.91608, "x":5.82119, "y":3.13245, "heading":2.50307, "vx":-0.31165, "vy":-1.8246, "omega":-1.78656, "ax":1.6148, "ay":-3.63796, "alpha":-1.33133, "fx":[25.11746,19.97687,26.19052,31.25993], "fy":[-53.6353,-58.77185,-61.81363,-56.80034]}, + {"t":3.93756, "x":5.81487, "y":3.09243, "heading":2.4647, "vx":-0.27697, "vy":-1.90274, "omega":-1.81516, "ax":2.14072, "ay":-3.33612, "alpha":-1.44055, "fx":[33.94937,28.10801,34.55683,39.32808], "fy":[-47.77848,-54.05942,-57.77436,-52.24115]}, + {"t":3.95904, "x":5.80941, "y":3.05079, "heading":2.42571, "vx":-0.23099, "vy":-1.97439, "omega":-1.8461, "ax":3.79077, "ay":-0.88431, "alpha":-1.7677, "fx":[59.89019,54.11633,60.67906,66.0392], "fy":[-6.8381,-14.76405,-20.99282,-13.56154]}, + {"t":3.98052, "x":5.80533, "y":3.00818, "heading":2.38606, "vx":-0.14957, "vy":-1.99339, "omega":-1.88407, "ax":3.43195, "ay":-0.19724, "alpha":-2.05324, "fx":[54.4663,47.17937,55.92935,60.364], "fy":[5.27681,-2.72728,-11.7272,-3.34757]}, + {"t":4.002, "x":5.8029, "y":2.96532, "heading":2.34559, "vx":-0.07586, "vy":-1.99762, "omega":-1.92817, "ax":-3.71501, "ay":0.21681, "alpha":-2.22763, "fx":[-59.36879,-66.09545,-58.88533,-51.56476], "fy":[12.61196,3.85682,-5.66918,2.9686]}, + {"t":4.02347, "x":5.80042, "y":2.92246, "heading":2.30418, "vx":-0.15565, "vy":-1.99297, "omega":-1.97601, "ax":-3.88169, "ay":0.4508, "alpha":-2.3442, "fx":[-61.65473,-68.828,-62.28082,-53.73535], "fy":[16.78066,7.89945,-2.64306,6.59009]}, + {"t":4.04495, "x":5.79618, "y":2.87976, "heading":2.26174, "vx":-0.23902, "vy":-1.98328, "omega":-2.02636, "ax":-3.73301, "ay":0.43904, "alpha":-1.90563, "fx":[-58.98763,-65.20382,-59.77152,-53.09403], "fy":[14.95767,7.81357,-0.86807,5.97695]}, + {"t":4.05824, "x":5.79267, "y":2.85344, "heading":2.23481, "vx":-0.28863, "vy":-1.97745, "omega":-2.05169, "ax":-3.79676, "ay":0.60095, "alpha":-1.74235, "fx":[-60.07598,-65.74976,-61.18968,-54.09006], "fy":[16.35666,10.65601,2.55407,8.59531]}, + {"t":4.07153, "x":5.7885, "y":2.82721, "heading":2.20754, "vx":-0.3391, "vy":-1.96946, "omega":-2.07485, "ax":-3.73339, "ay":0.6904, "alpha":-1.50492, "fx":[-58.65989,-63.89591,-60.01756,-54.50802], "fy":[17.31787,11.79681,4.76795,9.95949]}, + {"t":4.08482, "x":5.78367, "y":2.8011, "heading":2.17996, "vx":-0.38872, "vy":-1.96029, "omega":-2.09485, "ax":-3.64575, "ay":0.76915, "alpha":-1.45924, "fx":[-57.49031,-62.5875,-58.96466,-52.47323], "fy":[17.63655,13.43751,6.58047,11.18895]}, + {"t":4.09812, "x":5.77818, "y":2.77511, "heading":2.15212, "vx":-0.43717, "vy":-1.95006, "omega":-2.11424, "ax":-3.51919, "ay":0.8329, "alpha":-1.23994, "fx":[-55.10857,-59.76444,-56.71147,-51.89425], "fy":[18.36385,14.04884,8.29352,12.18555]}, + {"t":4.11141, "x":5.77206, "y":2.74927, "heading":2.12402, "vx":-0.48394, "vy":-1.93899, "omega":-2.13072, "ax":-3.23481, "ay":0.84515, "alpha":-1.22907, "fx":[-50.86514,-55.50661,-52.49373,-46.55439], "fy":[17.64028,14.75729,8.94379,12.32795]}, + {"t":4.1247, "x":5.76534, "y":2.72357, "heading":2.0957, "vx":-0.52694, "vy":-1.92776, "omega":-2.14706, "ax":-3.03052, "ay":0.86218, "alpha":-1.024, "fx":[-47.30081,-51.45228,-48.96286,-44.73071], "fy":[17.78925,14.49741,9.8304,12.63393]}, + {"t":4.13799, "x":5.75807, "y":2.69802, "heading":2.06717, "vx":-0.56721, "vy":-1.9163, "omega":-2.16067, "ax":-2.09735, "ay":0.63757, "alpha":-0.97345, "fx":[-32.64521,-36.64901,-34.27565,-29.61819], "fy":[13.38943,11.42377,6.66701,9.00738]}, + {"t":4.15128, "x":5.75034, "y":2.67261, "heading":2.03845, "vx":-0.59509, "vy":-1.90783, "omega":-2.1736, "ax":-1.90426, "ay":0.60711, "alpha":-0.81603, "fx":[-29.45037,-32.96929,-31.02873,-27.4774], "fy":[12.72855,10.51311,6.71281,8.59856]}, + {"t":4.16457, "x":5.74227, "y":2.64731, "heading":2.00956, "vx":-0.6204, "vy":-1.89976, "omega":-2.18445, "ax":-1.20849, "ay":0.40052, "alpha":-0.70433, "fx":[-18.49784,-21.56825,-19.95959,-16.71716], "fy":[8.75976,7.44224,3.86913,5.36317]}, + {"t":4.17786, "x":5.73391, "y":2.6221, "heading":1.98053, "vx":-0.63646, "vy":-1.89444, "omega":-2.19381, "ax":-0.89299, "ay":0.30321, "alpha":-0.57956, "fx":[-13.51373,-16.10432,-14.84508,-12.24439], "fy":[6.8833,5.66311,2.78419,3.92408]}, + {"t":4.19115, "x":5.72538, "y":2.59694, "heading":1.95137, "vx":-0.64833, "vy":-1.89041, "omega":-2.20151, "ax":-0.67562, "ay":0.23325, "alpha":-0.45099, "fx":[-10.15186,-12.19359,-11.27242,-9.28602], "fy":[5.28588,4.46843,2.11278,2.94489]}, + {"t":4.20444, "x":5.7167, "y":2.57184, "heading":1.92211, "vx":-0.65731, "vy":-1.88731, "omega":-2.20751, "ax":-0.33289, "ay":0.11674, "alpha":-0.34007, "fx":[-4.83075,-6.38357,-5.74005,-4.18532], "fy":[2.9836,2.50752,0.67985,1.2421]}, + {"t":4.21773, "x":5.70793, "y":2.54677, "heading":1.89277, "vx":-0.66173, "vy":-1.88575, "omega":-2.21203, "ax":-0.37322, "ay":0.1312, "alpha":-0.21148, "fx":[-5.58681,-6.56818,-6.19686,-5.34856], "fy":[2.87797,2.45956,1.33173,1.66253]}, + {"t":4.23102, "x":5.69911, "y":2.52171, "heading":1.86337, "vx":-0.66669, "vy":-1.88401, "omega":-2.21484, "ax":-0.06804, "ay":0.02435, "alpha":-0.10424, "fx":[-0.92417,-1.39916,-1.23625,-0.76128], "fy":[0.66405,0.6971,0.0256,0.15928]}, + {"t":4.24431, "x":5.69024, "y":2.49668, "heading":1.83393, "vx":-0.6676, "vy":-1.88369, "omega":-2.21622, "ax":-0.20508, "ay":0.07269, "alpha":0.02257, "fx":[-3.26006,-3.15073,-3.1837,-3.42894], "fy":[1.1808,1.07105,1.19681,1.16733]}, + {"t":4.2576, "x":5.68135, "y":2.47165, "heading":1.80448, "vx":-0.67032, "vy":-1.88272, "omega":-2.21592, "ax":0.03754, "ay":-0.01329, "alpha":0.13289, "fx":[0.35997,1.00659,0.83204,0.1856], "fy":[-0.72512,-0.37413,0.20811,0.04713]}, + {"t":4.2709, "x":5.67244, "y":2.44662, "heading":1.77503, "vx":-0.66982, "vy":-1.8829, "omega":-2.21416, "ax":-0.11167, "ay":0.03976, "alpha":0.26089, "fx":[-2.22608,-0.97159,-1.26709,-2.62632], "fy":[-0.10191,0.004,1.44172,1.18124]}, + {"t":4.28419, "x":5.66353, "y":2.4216, "heading":1.7456, "vx":-0.67131, "vy":-1.88237, "omega":-2.21069, "ax":0.06354, "ay":-0.02269, "alpha":0.37989, "fx":[0.27334,2.11346,1.74367,-0.09566], "fy":[-1.63271,-1.12588,0.82344,0.49448]}, + {"t":4.29748, "x":5.65461, "y":2.39658, "heading":1.71622, "vx":-0.67046, "vy":-1.88267, "omega":-2.20564, "ax":-0.05808, "ay":0.02075, "alpha":0.51386, "fx":[-1.94278,0.54529,0.13001,-2.42047], "fy":[-1.17155,-0.94806,1.90115,1.53622]}, + {"t":4.31077, "x":5.6457, "y":2.37156, "heading":1.6869, "vx":-0.67124, "vy":-1.88239, "omega":-2.19881, "ax":0.05, "ay":-0.01788, "alpha":0.647, "fx":[-0.56927,2.57396,2.15618,-0.98569], "fy":[-2.30487,-1.79886,1.66819,1.30013]}, + {"t":4.32406, "x":5.63678, "y":2.34654, "heading":1.65768, "vx":-0.67057, "vy":-1.88263, "omega":-2.19021, "ax":-0.02501, "ay":0.00892, "alpha":0.79222, "fx":[-2.12629,1.72442,1.34151,-2.52816], "fy":[-2.15071,-1.92024,2.48641,2.15081]}, + {"t":4.33735, "x":5.62787, "y":2.32152, "heading":1.62857, "vx":-0.6709, "vy":-1.88251, "omega":-2.17968, "ax":0.00285, "ay":-0.00067, "alpha":0.94323, "fx":[-2.10272,2.49612,2.19129,-2.40398], "fy":[-2.79959,-2.41773,2.72003,2.45481]}, + {"t":4.35064, "x":5.61895, "y":2.2965, "heading":1.5996, "vx":-0.67087, "vy":-1.88252, "omega":-2.16715, "ax":0.00918, "ay":0.11587, "alpha":1.10519, "fx":[-2.46227,2.93397,2.74877,-2.63725], "fy":[-1.33962,-1.08134,4.96458,4.81434]}, + {"t":4.36393, "x":5.61003, "y":2.27149, "heading":1.5708, "vx":-0.67074, "vy":-1.88098, "omega":-2.15246, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[ {"name":"IntakeDown", "from":{"target":0, "targetTimestamp":0.0, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeDown"}}}, - {"name":"IntakeUp", "from":{"target":null, "targetTimestamp":null, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] + {"name":"IntakeUp", "from":{"target":5, "targetTimestamp":4.04495, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] } diff --git a/src/main/deploy/choreo/RightSecondDipShort.traj b/src/main/deploy/choreo/RightSecondDipShort.traj new file mode 100644 index 00000000..2154cb29 --- /dev/null +++ b/src/main/deploy/choreo/RightSecondDipShort.traj @@ -0,0 +1,207 @@ +{ + "name":"RightSecondDipShort", + "version":3, + "snapshot":{ + "waypoints":[ + {"x":5.607864856719971, "y":2.2545297145843506, "heading":1.5707963267948966, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":7.415774345397949, "y":3.393817186355591, "heading":2.7446892183710663, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":6.060224533081055, "y":3.563260793685913, "heading":3.141592653589793, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.796180248260498, "y":2.8797600269317627, "heading":2.2617395073648874, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":5.6100335121154785, "y":2.2714898586273193, "heading":1.5707963267948966, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + "constraints":[ + {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":false}, + {"from":0, "to":4, "data":{"type":"MaxAcceleration", "props":{"max":4.0}}, "enabled":true}, + {"from":0, "to":4, "data":{"type":"MaxAngularVelocity", "props":{"max":4.0}}, "enabled":true}, + {"from":2, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"first", "to":1, "data":{"type":"MaxVelocity", "props":{"max":3.0}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"MaxVelocity", "props":{"max":1.0}}, "enabled":true}, + {"from":2, "to":4, "data":{"type":"MaxVelocity", "props":{"max":2.0}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"KeepInLane", "props":{"tolerance":0.01}}, "enabled":true}], + "targetDt":0.05 + }, + "params":{ + "waypoints":[ + {"x":{"exp":"5.607864856719971 m", "val":5.607864856719971}, "y":{"exp":"2.2545297145843506 m", "val":2.2545297145843506}, "heading":{"exp":"1.5707963267948966 rad", "val":1.5707963267948966}, "intervals":39, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"7.415774345397949 m", "val":7.415774345397949}, "y":{"exp":"3.393817186355591 m", "val":3.393817186355591}, "heading":{"exp":"2.7446892183710663 rad", "val":2.7446892183710663}, "intervals":38, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"6.060224533081055 m", "val":6.060224533081055}, "y":{"exp":"3.563260793685913 m", "val":3.563260793685913}, "heading":{"exp":"3.141592653589793 rad", "val":3.141592653589793}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.796180248260498 m", "val":5.796180248260498}, "y":{"exp":"2.8797600269317627 m", "val":2.8797600269317627}, "heading":{"exp":"2.2617395073648874 rad", "val":2.2617395073648874}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"5.6100335121154785 m", "val":5.6100335121154785}, "y":{"exp":"2.2714898586273193 m", "val":2.2714898586273193}, "heading":{"exp":"1.5707963267948966 rad", "val":1.5707963267948966}, "intervals":24, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + "constraints":[ + {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":false}, + {"from":0, "to":4, "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"4 m / s ^ 2", "val":4.0}}}, "enabled":true}, + {"from":0, "to":4, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"4 rad / s", "val":4.0}}}, "enabled":true}, + {"from":2, "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":false}, + {"from":"first", "to":1, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"3 m / s", "val":3.0}}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"1 m / s", "val":1.0}}}, "enabled":true}, + {"from":2, "to":4, "data":{"type":"MaxVelocity", "props":{"max":{"exp":"2 m / s", "val":2.0}}}, "enabled":true}, + {"from":1, "to":2, "data":{"type":"KeepInLane", "props":{"tolerance":{"exp":"0.01 m", "val":0.01}}}, "enabled":true}], + "targetDt":{ + "exp":"0.05 s", + "val":0.05 + } + }, + "trajectory":{ + "config":{ + "frontLeft":{ + "x":0.263525, + "y":0.301625 + }, + "backLeft":{ + "x":-0.263525, + "y":0.301625 + }, + "mass":63.502931800000006, + "inertia":5.903712368280681, + "gearing":5.27, + "radius":0.0508, + "vmax":555.0147021341968, + "tmax":1.3, + "cof":1.0, + "bumper":{ + "front":0.4460875, + "side":0.4079875, + "back":0.4460875 + }, + "differentialTrackWidth":0.5588 + }, + "sampleType":"Swerve", + "waypoints":[0.0,1.0994,2.56815,3.12829,3.44732], + "samples":[ + {"t":0.0, "x":5.60786, "y":2.25453, "heading":1.5708, "vx":2.68018, "vy":1.33827, "omega":0.9643, "ax":0.0652, "ay":0.12419, "alpha":0.50595, "fx":[-0.19131,2.27287,2.25961,-0.20106], "fy":[0.54036,0.60274,3.36542,3.37797]}, + {"t":0.02819, "x":5.68344, "y":2.2923, "heading":1.59798, "vx":2.68202, "vy":1.34177, "omega":0.97857, "ax":0.00478, "ay":-0.00946, "alpha":0.4392, "fx":[-0.96953,1.18933,1.12086,-1.03715], "fy":[-1.44042,-1.26958,1.08349,1.02553]}, + {"t":0.05638, "x":5.75905, "y":2.33013, "heading":1.62557, "vx":2.68215, "vy":1.34151, "omega":0.99095, "ax":0.01789, "ay":-0.03578, "alpha":0.38497, "fx":[-0.59872,1.2895,1.17037,-0.72498], "fy":[-1.62593,-1.62106,0.53954,0.43546]}, + {"t":0.08457, "x":5.83467, "y":2.36793, "heading":1.6535, "vx":2.68265, "vy":1.3405, "omega":1.0018, "ax":0.02171, "ay":-0.0435, "alpha":0.34149, "fx":[-0.41998,1.27,1.1091,-0.58031], "fy":[-1.76128,-1.4682,0.30377,0.16315]}, + {"t":0.11276, "x":5.9103, "y":2.4057, "heading":1.68174, "vx":2.68327, "vy":1.33927, "omega":1.01143, "ax":0.00685, "ay":-0.01375, "alpha":0.30503, "fx":[-0.56993,0.95928,0.76355,-0.71806], "fy":[-1.04671,-1.05106,0.69807,0.52642]}, + {"t":0.14095, "x":5.98594, "y":2.44345, "heading":1.71025, "vx":2.68346, "vy":1.33888, "omega":1.02003, "ax":-0.0072, "ay":0.0145, "alpha":0.28833, "fx":[-0.71605,0.71826,0.48719,-0.9463], "fy":[-0.73445,-0.33255,1.09464,0.89285]}, + {"t":0.16914, "x":6.06159, "y":2.4812, "heading":1.73901, "vx":2.68326, "vy":1.33929, "omega":1.02815, "ax":-0.0659, "ay":0.13165, "alpha":0.27611, "fx":[-1.5991,-0.23865,-0.50354,-1.84336], "fy":[1.28862,1.39896,2.953,2.71972]}, + {"t":0.19733, "x":6.1372, "y":2.519, "heading":1.76799, "vx":2.6814, "vy":1.343, "omega":1.03594, "ax":-0.15033, "ay":0.2992, "alpha":0.28073, "fx":[-2.90794,-1.5575,-1.86573,-3.21504], "fy":[3.84532,4.14346,5.64084,5.37031]}, + {"t":0.22552, "x":6.21273, "y":2.55698, "heading":1.79719, "vx":2.67716, "vy":1.35144, "omega":1.04385, "ax":-0.33034, "ay":0.64874, "alpha":0.29108, "fx":[-5.7644,-4.41306,-4.76565,-6.03456], "fy":[9.23695,9.73662,11.26951,10.95375]}, + {"t":0.25371, "x":6.28807, "y":2.59534, "heading":1.82662, "vx":2.66785, "vy":1.36972, "omega":1.05206, "ax":-0.64174, "ay":1.2301, "alpha":0.31783, "fx":[-10.68767,-9.28279,-9.68739,-11.09439], "fy":[18.70603,18.48872,20.64728,20.27294]}, + {"t":0.2819, "x":6.36302, "y":2.63444, "heading":1.85628, "vx":2.64976, "vy":1.4044, "omega":1.06102, "ax":-1.10411, "ay":2.02889, "alpha":0.36254, "fx":[-18.11654,-16.63486,-17.08989,-18.27294], "fy":[30.32058,31.91768,33.52328,33.07923]}, + {"t":0.31009, "x":6.43728, "y":2.67483, "heading":1.88619, "vx":2.61863, "vy":1.4616, "omega":1.07124, "ax":-2.02003, "ay":2.76712, "alpha":0.35896, "fx":[-32.54689,-31.20563,-31.5516,-32.97379], "fy":[43.2925,42.11496,45.42707,44.8855]}, + {"t":0.33828, "x":6.51029, "y":2.71713, "heading":1.91638, "vx":2.56169, "vy":1.5396, "omega":1.08135, "ax":-3.69689, "ay":-1.41366, "alpha":0.22964, "fx":[-59.05927,-57.96567,-58.57572,-59.16262], "fy":[-23.13618,-23.2079,-21.46226,-21.96536]}, + {"t":0.36647, "x":6.58104, "y":2.75997, "heading":1.94687, "vx":2.45748, "vy":1.49975, "omega":1.08783, "ax":-3.64015, "ay":-1.60903, "alpha":0.27443, "fx":[-57.93961,-56.97369,-57.61035,-58.63666], "fy":[-26.73945,-25.88295,-24.56696,-24.98852]}, + {"t":0.39466, "x":6.64887, "y":2.80161, "heading":1.97753, "vx":2.35486, "vy":1.45439, "omega":1.09556, "ax":-3.61995, "ay":-1.67056, "alpha":0.2448, "fx":[-57.74224,-56.65593,-57.41717,-58.06228], "fy":[-27.29907,-27.24629,-25.48666,-26.05319]}, + {"t":0.42285, "x":6.71381, "y":2.84195, "heading":2.00842, "vx":2.25281, "vy":1.4073, "omega":1.10247, "ax":-3.60968, "ay":-1.70058, "alpha":0.27529, "fx":[-57.38323,-56.47321,-57.19941,-58.16956], "fy":[-28.16279,-27.37326,-25.98888,-26.46671]}, + {"t":0.45104, "x":6.77589, "y":2.88094, "heading":2.0395, "vx":2.15106, "vy":1.35936, "omega":1.11023, "ax":-3.60348, "ay":-1.71833, "alpha":0.24226, "fx":[-57.36687,-56.39111,-57.18566,-57.88792], "fy":[-28.08467,-27.89361,-26.27564,-26.86534]}, + {"t":0.47923, "x":6.83509, "y":2.91858, "heading":2.07079, "vx":2.04948, "vy":1.31092, "omega":1.11706, "ax":-3.5993, "ay":-1.73013, "alpha":0.24639, "fx":[-57.15206,-56.38933,-57.10191,-57.92284], "fy":[-28.52123,-27.76451,-26.54315,-27.03922]}, + {"t":0.50742, "x":6.89144, "y":2.95485, "heading":2.10228, "vx":1.94801, "vy":1.26215, "omega":1.124, "ax":-3.5963, "ay":-1.73851, "alpha":0.19545, "fx":[-57.20263,-56.40388,-57.13233,-57.63673], "fy":[-28.23676,-28.07634,-26.74405,-27.34362]}, + {"t":0.53561, "x":6.94492, "y":2.98974, "heading":2.13397, "vx":1.84663, "vy":1.21314, "omega":1.12951, "ax":-3.59404, "ay":-1.74478, "alpha":0.1924, "fx":[-57.01664,-56.47419,-57.06693,-57.67447], "fy":[-28.5633,-27.84348,-26.9717,-27.42029]}, + {"t":0.5638, "x":6.99555, "y":3.02324, "heading":2.16581, "vx":1.74532, "vy":1.16395, "omega":1.13493, "ax":-3.59228, "ay":-1.74966, "alpha":0.1442, "fx":[-57.06181,-56.519,-57.08408,-57.45511], "fy":[-28.25973,-28.0867,-27.14901,-27.61305]}, + {"t":0.59199, "x":7.04332, "y":3.05536, "heading":2.1978, "vx":1.64405, "vy":1.11463, "omega":1.139, "ax":-3.59087, "ay":-1.75354, "alpha":0.12018, "fx":[-56.9469,-56.65179,-57.03851,-57.39336], "fy":[-28.4112,-27.85606,-27.38416,-27.70326]}, + {"t":0.62018, "x":7.08824, "y":3.08608, "heading":2.22991, "vx":1.54283, "vy":1.0652, "omega":1.14239, "ax":-3.58971, "ay":-1.75672, "alpha":0.04857, "fx":[-57.05901,-56.77089,-57.06966,-57.05728], "fy":[-27.99963,-28.0414,-27.58471,-27.9309]}, + {"t":0.64837, "x":7.13031, "y":3.11541, "heading":2.26211, "vx":1.44163, "vy":1.01568, "omega":1.14376, "ax":-3.58874, "ay":-1.75936, "alpha":0.02818, "fx":[-56.93532,-56.91189,-56.98496,-57.06329], "fy":[-28.12537,-27.82583,-27.84082,-27.93243]}, + {"t":0.67656, "x":7.16952, "y":3.14335, "heading":2.29436, "vx":1.34047, "vy":0.96608, "omega":1.14455, "ax":-3.58792, "ay":-1.76159, "alpha":-0.05196, "fx":[-57.06574,-57.06598,-56.98689,-56.72493], "fy":[-27.67242,-27.98421,-28.08111,-28.12837]}, + {"t":0.70475, "x":7.20588, "y":3.16988, "heading":2.32662, "vx":1.23932, "vy":0.91642, "omega":1.14309, "ax":-3.58722, "ay":-1.76351, "alpha":-0.08615, "fx":[-56.98679,-57.25518,-56.88455,-56.67225], "fy":[-27.7229,-27.77003,-28.37539,-28.11957]}, + {"t":0.73294, "x":7.23939, "y":3.19501, "heading":2.35884, "vx":1.1382, "vy":0.86671, "omega":1.14066, "ax":-3.58661, "ay":-1.76516, "alpha":-0.17567, "fx":[-57.1444,-57.44467,-56.85605,-56.31494], "fy":[-27.23032,-27.93299,-28.65346,-28.27637]}, + {"t":0.76113, "x":7.27005, "y":3.21874, "heading":2.391, "vx":1.03709, "vy":0.81695, "omega":1.13571, "ax":-3.58607, "ay":-1.76661, "alpha":-0.22489, "fx":[-57.11736,-57.67295,-56.72236,-56.21348], "fy":[-27.1872,-27.75551,-28.99652,-28.24592]}, + {"t":0.78932, "x":7.29786, "y":3.24107, "heading":2.42302, "vx":0.936, "vy":0.76715, "omega":1.12937, "ax":-3.5856, "ay":-1.76789, "alpha":-0.32528, "fx":[-57.30392,-57.89261,-56.63806,-55.86151], "fy":[-26.64456,-27.92985,-29.34303,-28.34906]}, + {"t":0.81751, "x":7.32283, "y":3.26199, "heading":2.45485, "vx":0.83493, "vy":0.71731, "omega":1.1202, "ax":-3.58518, "ay":-1.76903, "alpha":-0.39454, "fx":[-57.34276,-58.18065,-56.47518,-55.6709], "fy":[-26.51299,-27.77995,-29.73742,-28.30821]}, + {"t":0.8457, "x":7.34494, "y":3.28151, "heading":2.48643, "vx":0.73386, "vy":0.66744, "omega":1.10907, "ax":-3.5848, "ay":-1.77005, "alpha":-0.51296, "fx":[-57.58134,-58.4476,-56.33782,-55.27882], "fy":[-25.89564,-27.9789,-30.15753,-28.3711]}, + {"t":0.87389, "x":7.3642, "y":3.29962, "heading":2.51769, "vx":0.63281, "vy":0.61755, "omega":1.09461, "ax":-3.58447, "ay":-1.77096, "alpha":-0.6029, "fx":[-57.68823,-58.79096,-56.1181,-55.02678], "fy":[-25.67666,-27.8682,-30.62817,-28.28825]}, + {"t":0.90208, "x":7.38061, "y":3.31633, "heading":2.54855, "vx":0.53176, "vy":0.56762, "omega":1.07762, "ax":-3.58416, "ay":-1.77179, "alpha":-0.74424, "fx":[-57.99647,-59.11589,-55.91613,-54.57609], "fy":[-24.9735,-28.10877,-31.13489,-28.29668]}, + {"t":0.93027, "x":7.39418, "y":3.33163, "heading":2.57893, "vx":0.43072, "vy":0.51768, "omega":1.05664, "ax":-3.58388, "ay":-1.77254, "alpha":-0.86059, "fx":[-58.18671,-59.52263,-55.61967,-54.25781], "fy":[-24.64506,-28.04943,-31.70662,-28.16057]}, + {"t":0.95845, "x":7.4049, "y":3.34552, "heading":2.60872, "vx":0.32969, "vy":0.46771, "omega":1.03238, "ax":-3.58362, "ay":-1.77323, "alpha":-1.02969, "fx":[-58.58044,-59.91341,-55.33485,-53.74196], "fy":[-23.84741,-28.35368,-32.31869,-28.08548]}, + {"t":0.98664, "x":7.41277, "y":3.358, "heading":2.63782, "vx":0.22867, "vy":0.41772, "omega":1.00335, "ax":-3.58339, "ay":-1.77386, "alpha":-1.18081, "fx":[-58.88338,-60.38303,-54.94825,-53.34118], "fy":[-23.35646,-28.42024,-32.99908,-27.86939]}, + {"t":1.01483, "x":7.41779, "y":3.36907, "heading":2.6661, "vx":0.12766, "vy":0.36772, "omega":0.97006, "ax":-3.58318, "ay":-1.77444, "alpha":-1.38112, "fx":[-59.36548,-60.87218,-54.55341,-52.75109], "fy":[-22.50548,-28.73247,-33.74856,-27.69545]}, + {"t":1.04302, "x":7.41997, "y":3.37873, "heading":2.69345, "vx":0.02665, "vy":0.3177, "omega":0.93113, "ax":-3.58298, "ay":-1.77497, "alpha":-1.58111, "fx":[-59.82022,-61.43091,-54.04666,-52.23175], "fy":[-21.79813,-28.91066,-34.59768,-27.4094]}, + {"t":1.07121, "x":7.41929, "y":3.38698, "heading":2.7197, "vx":-0.07436, "vy":0.26766, "omega":0.88656, "ax":-3.58279, "ay":-1.77547, "alpha":-1.81632, "fx":[-60.39561,-62.03113,-53.49967,-51.59145], "fy":[-20.89889,-29.2318,-35.51915,-27.09747]}, + {"t":1.0994, "x":7.41577, "y":3.39382, "heading":2.74469, "vx":-0.17535, "vy":0.21761, "omega":0.83536, "ax":-3.63903, "ay":-1.65507, "alpha":-1.71237, "fx":[-61.11151,-62.56008,-54.53642,-52.88096], "fy":[-19.43708,-27.48233,-33.21207,-24.97062]}, + {"t":1.13806, "x":7.40628, "y":3.40099, "heading":2.77698, "vx":-0.31601, "vy":0.15364, "omega":0.76917, "ax":-3.78502, "ay":-1.28902, "alpha":-1.42607, "fx":[-62.78287,-63.98054,-57.44109,-56.15563], "fy":[-14.77169,-21.78091,-26.3248,-18.9793]}, + {"t":1.17671, "x":7.39124, "y":3.40597, "heading":2.80671, "vx":-0.4623, "vy":0.10382, "omega":0.71405, "ax":-3.95702, "ay":-0.56989, "alpha":-1.18539, "fx":[-64.84671,-66.00659,-60.821,-59.60832], "fy":[-4.3492,-10.58214,-13.93344,-7.32509]}, + {"t":1.21536, "x":7.37041, "y":3.40955, "heading":2.83431, "vx":-0.61525, "vy":0.08179, "omega":0.66824, "ax":-3.99305, "ay":0.17012, "alpha":-0.98938, "fx":[-64.91368,-66.09307,-61.89393,-60.66944], "fy":[6.51559,0.94778,-1.21098,4.5507]}, + {"t":1.25401, "x":7.34365, "y":3.41284, "heading":2.86013, "vx":-0.76958, "vy":0.08837, "omega":0.63, "ax":-3.97921, "ay":0.33529, "alpha":-0.82838, "fx":[-64.45319,-65.44432,-61.90998,-60.88406], "fy":[8.43843,3.66703,2.15978,7.02692]}, + {"t":1.29266, "x":7.31093, "y":3.41651, "heading":2.88448, "vx":-0.92338, "vy":0.10133, "omega":0.59798, "ax":-1.84911, "ay":-0.0668, "alpha":-0.94212, "fx":[-31.23903,-32.36971,-27.48863,-26.32652], "fy":[1.8962,-2.51962,-4.15636,0.53753]}, + {"t":1.33131, "x":7.27386, "y":3.42037, "heading":2.9076, "vx":-0.99485, "vy":0.09874, "omega":0.56156, "ax":0.01307, "ay":0.1286, "alpha":-0.8514, "fx":[-1.61743,-2.59479,2.03475,3.00723], "fy":[4.57254,0.65658,-0.53643,3.47346]}, + {"t":1.36996, "x":7.23542, "y":3.42429, "heading":2.9293, "vx":-0.99435, "vy":0.10371, "omega":0.52866, "ax":0.00975, "ay":0.09186, "alpha":-0.69996, "fx":[-1.39329,-2.12379,1.7045,2.43161], "fy":[3.50636,0.27204,-0.62635,2.68158]}, + {"t":1.40861, "x":7.19699, "y":3.42836, "heading":2.94973, "vx":-0.99397, "vy":0.10726, "omega":0.5016, "ax":0.0073, "ay":0.06679, "alpha":-0.57762, "fx":[-1.19549,-1.74132,1.42805,1.97206], "fy":[2.72747,0.02908,-0.62579,2.11061]}, + {"t":1.44726, "x":7.15858, "y":3.43256, "heading":2.96912, "vx":-0.99369, "vy":0.10985, "omega":0.47928, "ax":0.006, "ay":0.05379, "alpha":-0.47889, "fx":[-1.01762,-1.42535,1.20869,1.6155], "fy":[2.21769,-0.04441,-0.5147,1.75716]}, + {"t":1.48592, "x":7.12018, "y":3.43685, "heading":2.98765, "vx":-0.99346, "vy":0.11192, "omega":0.46077, "ax":0.00515, "ay":0.04533, "alpha":-0.40026, "fx":[-0.86901,-1.17425,1.03269,1.33744], "fy":[1.84348,-0.06261,-0.40158,1.49921]}, + {"t":1.52457, "x":7.08178, "y":3.44121, "heading":3.00546, "vx":-0.99326, "vy":0.11368, "omega":0.4453, "ax":0.00453, "ay":0.03934, "alpha":-0.33786, "fx":[-0.7475,-0.97648,0.89156,1.12028], "fy":[1.55887,-0.05678,-0.30493,1.30114]}, + {"t":1.56322, "x":7.0434, "y":3.44563, "heading":3.02267, "vx":-0.99308, "vy":0.1152, "omega":0.43224, "ax":0.00408, "ay":0.03499, "alpha":-0.29011, "fx":[-0.65312,-0.82609,0.78283,0.95565], "fy":[1.3449,-0.04401,-0.22977,1.15072]}, + {"t":1.60187, "x":7.00502, "y":3.45011, "heading":3.03937, "vx":-0.99293, "vy":0.11655, "omega":0.42103, "ax":0.00374, "ay":0.03173, "alpha":-0.25434, "fx":[-0.58235,-0.71391,0.70128,0.83276], "fy":[1.18414,-0.03146,-0.17469,1.03692]}, + {"t":1.64052, "x":6.96664, "y":3.45464, "heading":3.05565, "vx":-0.99278, "vy":0.11778, "omega":0.41119, "ax":0.00349, "ay":0.02924, "alpha":-0.23006, "fx":[-0.53608,-0.63739,0.64679,0.74803], "fy":[1.06912,-0.02758,-0.14091,0.95616]}, + {"t":1.67917, "x":6.92827, "y":3.45921, "heading":3.07154, "vx":-0.99265, "vy":0.11891, "omega":0.4023, "ax":0.00329, "ay":0.02733, "alpha":-0.2155, "fx":[-0.51168,-0.59028,0.61613,0.69469], "fy":[0.99078,-0.03324,-0.12524,0.90347]}, + {"t":1.71782, "x":6.88991, "y":3.46383, "heading":3.08709, "vx":-0.99252, "vy":0.11996, "omega":0.39397, "ax":0.00314, "ay":0.0259, "alpha":-0.21098, "fx":[-0.51126,-0.57248,0.61109,0.67227], "fy":[0.94719,-0.05355,-0.12847,0.87945]}, + {"t":1.75647, "x":6.85155, "y":3.46848, "heading":3.10232, "vx":-0.9924, "vy":0.12096, "omega":0.38582, "ax":0.00304, "ay":0.02486, "alpha":-0.21559, "fx":[-0.5339,-0.58053,0.63052,0.67711], "fy":[0.93349,-0.08831,-0.14861,0.88212]}, + {"t":1.79512, "x":6.81319, "y":3.47318, "heading":3.11723, "vx":-0.99228, "vy":0.12192, "omega":0.37749, "ax":0.00298, "ay":0.02417, "alpha":-0.23028, "fx":[-0.58317,-0.61617,0.67784,0.71081], "fy":[0.95037,-0.14243,-0.1874,0.91424]}, + {"t":1.83378, "x":6.77484, "y":3.47791, "heading":3.13182, "vx":-0.99216, "vy":0.12286, "omega":0.36859, "ax":0.00296, "ay":0.02379, "alpha":-0.25514, "fx":[-0.66055,-0.67875,0.75447,0.77263], "fy":[0.99616,-0.21704,-0.24471,0.97655]}, + {"t":1.87243, "x":6.7365, "y":3.48267, "heading":-3.13712, "vx":-0.99205, "vy":0.12378, "omega":0.35872, "ax":0.00297, "ay":0.02372, "alpha":-0.29174, "fx":[-0.77127,-0.77152,0.86561,0.86581], "fy":[1.0734,-0.31789,-0.32316,1.07384]}, + {"t":1.91108, "x":6.69815, "y":3.48748, "heading":-3.12325, "vx":-0.99194, "vy":0.12469, "omega":0.34745, "ax":0.00302, "ay":0.02394, "alpha":-0.34135, "fx":[-0.92007,-0.89694,1.01602,0.99282], "fy":[1.18364,-0.44883,-0.42482,1.21026]}, + {"t":1.94973, "x":6.65982, "y":3.49231, "heading":-3.10983, "vx":-0.99182, "vy":0.12562, "omega":0.33425, "ax":0.00311, "ay":0.02447, "alpha":-0.40625, "fx":[-1.11435,-1.05988,1.21317,1.15859], "fy":[1.33114,-0.61699,-0.55342,1.39291]}, + {"t":1.98838, "x":6.62148, "y":3.49719, "heading":-3.09691, "vx":-0.9917, "vy":0.12657, "omega":0.31855, "ax":0.00324, "ay":0.02532, "alpha":-0.48923, "fx":[-1.36322,-1.26654,1.46632,1.36945], "fy":[1.52113,-0.82992,-0.7137,1.63038]}, + {"t":2.02703, "x":6.58316, "y":3.5021, "heading":-3.08459, "vx":-0.99157, "vy":0.12754, "omega":0.29964, "ax":0.00343, "ay":0.02655, "alpha":-0.59354, "fx":[-1.67714,-1.52403,1.78616,1.63274], "fy":[1.76013,-1.09631,-0.91103,1.93296]}, + {"t":2.06568, "x":6.54483, "y":3.50705, "heading":-3.07301, "vx":-0.99144, "vy":0.12857, "omega":0.2767, "ax":0.00367, "ay":0.02821, "alpha":-0.7239, "fx":[-2.07101,-1.84339,2.18794,1.95979], "fy":[2.05813,-1.42799,-1.1537,2.31508]}, + {"t":2.10433, "x":6.50652, "y":3.51204, "heading":-3.06232, "vx":-0.9913, "vy":0.12966, "omega":0.24872, "ax":0.004, "ay":0.0304, "alpha":-0.88502, "fx":[-2.55979,-2.23548,2.68711,2.36185], "fy":[2.42502,-1.83545,-1.45018,2.79131]}, + {"t":2.14299, "x":6.4682, "y":3.51707, "heading":-3.0527, "vx":-0.99114, "vy":0.13084, "omega":0.21452, "ax":0.00441, "ay":0.03323, "alpha":-1.08412, "fx":[-3.16575,-2.71806,3.30663,2.85712], "fy":[2.87685,-2.33537,-1.81433,3.38297]}, + {"t":2.18164, "x":6.4299, "y":3.52215, "heading":-3.04441, "vx":-0.99097, "vy":0.13212, "omega":0.17261, "ax":0.00494, "ay":0.03689, "alpha":-1.32809, "fx":[-3.9101,-3.30857,4.06893,3.46374], "fy":[3.43024,-2.93945,-2.25962,4.11118]}, + {"t":2.22029, "x":6.3916, "y":3.52729, "heading":-3.03774, "vx":-0.99078, "vy":0.13355, "omega":0.12128, "ax":0.00568, "ay":0.04189, "alpha":-1.62738, "fx":[-4.82291,-4.03416,5.00726,4.21055], "fy":[4.11589,-3.66355,-2.80284,5.0105]}, + {"t":2.25894, "x":6.35331, "y":3.53248, "heading":-3.03305, "vx":-0.99056, "vy":0.13517, "omega":0.05838, "ax":0.00677, "ay":0.04929, "alpha":-1.99212, "fx":[-5.93104,-4.92259,6.15514,5.12867], "fy":[4.97383,-4.5098,-3.45455,6.12066]}, + {"t":2.29759, "x":6.31503, "y":3.53774, "heading":-3.0308, "vx":-0.9903, "vy":0.13707, "omega":-0.01862, "ax":0.0084, "ay":0.06018, "alpha":-2.43668, "fx":[-7.27036,-6.01581,7.5575,6.26222], "fy":[6.05851,-5.49151,-4.23483,7.48971]}, + {"t":2.33624, "x":6.27676, "y":3.54308, "heading":-3.03152, "vx":-0.98998, "vy":0.1394, "omega":-0.1128, "ax":0.0108, "ay":0.07586, "alpha":-2.97619, "fx":[-8.87277,-7.3613,9.25868,7.66094], "fy":[7.43735,-6.62023,-5.16512,9.16507]}, + {"t":2.37489, "x":6.2385, "y":3.54853, "heading":-3.03588, "vx":-0.98956, "vy":0.14233, "omega":-0.22783, "ax":0.01663, "ay":0.11385, "alpha":-3.63492, "fx":[-10.74058,-8.98483,11.34536,9.43633], "fy":[9.47866,-7.70732,-6.02244,11.48115]}, + {"t":2.41354, "x":6.20027, "y":3.55412, "heading":-3.04468, "vx":-0.98892, "vy":0.14673, "omega":-0.36832, "ax":0.0318, "ay":0.20825, "alpha":-4.44418, "fx":[-12.81475,-10.83285,13.86707,11.79963], "fy":[12.85969,-8.43537,-6.30607,15.10605]}, + {"t":2.45219, "x":6.16207, "y":3.55994, "heading":-3.05892, "vx":-0.98769, "vy":0.15478, "omega":-0.5401, "ax":2.11125, "ay":-0.99747, "alpha":-4.50414, "fx":[21.13309,21.64591,45.36369,45.92789], "fy":[-6.33805,-29.53407,-24.60328,-2.86685]}, + {"t":2.49085, "x":6.12547, "y":3.56518, "heading":-3.07979, "vx":-0.90608, "vy":0.11622, "omega":-0.71419, "ax":1.75893, "ay":-3.58844, "alpha":-4.41156, "fx":[14.4687,14.02106,39.76893,43.43856], "fy":[-50.73851,-68.49962,-63.38669,-45.25181]}, + {"t":2.5295, "x":6.09176, "y":3.56699, "heading":-3.1074, "vx":-0.8381, "vy":-0.02247, "omega":-0.8847, "ax":1.14437, "ay":-3.83141, "alpha":-5.30079, "fx":[0.8102,1.50848,32.9155,37.43639], "fy":[-52.87703,-73.00296,-69.02613,-48.3994]}, + {"t":2.56815, "x":6.06022, "y":3.56326, "heading":3.14159, "vx":-0.79387, "vy":-0.17056, "omega":-1.08958, "ax":1.05622, "ay":-3.85415, "alpha":-3.07554, "fx":[7.22375,6.53229,25.38835,27.92888], "fy":[-56.24022,-67.97181,-66.21318,-54.32472]}, + {"t":2.58969, "x":6.04337, "y":3.55869, "heading":3.11812, "vx":-0.77111, "vy":-0.2536, "omega":-1.15584, "ax":1.05989, "ay":-3.85499, "alpha":-2.76692, "fx":[8.57518,7.40786,24.44506,26.87777], "fy":[-56.4058,-67.27723,-65.894,-55.22633]}, + {"t":2.61124, "x":6.027, "y":3.55233, "heading":3.09322, "vx":-0.74828, "vy":-0.33665, "omega":-1.21545, "ax":1.06337, "ay":-3.85393, "alpha":-2.50167, "fx":[9.58358,8.15996,23.6046,26.17884], "fy":[-56.8446,-66.47456,-65.56836,-55.84854]}, + {"t":2.63278, "x":6.01113, "y":3.54419, "heading":3.06703, "vx":-0.72537, "vy":-0.41968, "omega":-1.26935, "ax":1.06721, "ay":-3.85276, "alpha":-2.26675, "fx":[10.64203,8.88594,22.89275,25.35034], "fy":[-56.90358,-65.94839,-65.29781,-56.51172]}, + {"t":2.65432, "x":5.99575, "y":3.53425, "heading":3.03968, "vx":-0.70238, "vy":-0.50268, "omega":-1.31818, "ax":1.07147, "ay":-3.85145, "alpha":-2.05542, "fx":[11.43026,9.53922,22.22037,24.85195], "fy":[-57.29161,-65.26959,-65.02559,-56.9917]}, + {"t":2.67587, "x":5.98086, "y":3.52253, "heading":3.01129, "vx":-0.67929, "vy":-0.58566, "omega":-1.36246, "ax":1.07623, "ay":-3.84999, "alpha":-1.8681, "fx":[12.31471,10.17455,21.69221,24.16244], "fy":[-57.30645,-64.87382,-64.78997,-57.5152]}, + {"t":2.69741, "x":5.96648, "y":3.50902, "heading":2.98193, "vx":-0.65611, "vy":-0.6686, "omega":-1.40271, "ax":1.08157, "ay":-3.84833, "alpha":-1.70398, "fx":[12.91558,10.73513,21.18903,23.84335], "fy":[-57.65619,-64.29717,-64.55657,-57.87057]}, + {"t":2.71896, "x":5.95259, "y":3.49372, "heading":2.95171, "vx":-0.63281, "vy":-0.75151, "omega":-1.43942, "ax":1.08761, "ay":-3.84645, "alpha":-1.55912, "fx":[13.6649,11.28936,20.82395,23.2885], "fy":[-57.61504,-64.01524,-64.3602,-58.27069]}, + {"t":2.7405, "x":5.93921, "y":3.47664, "heading":2.9207, "vx":-0.60938, "vy":-0.83438, "omega":-1.47301, "ax":1.0945, "ay":-3.8443, "alpha":-1.43173, "fx":[14.12087,11.78749,20.46173,23.13369], "fy":[-57.94274,-63.468,-64.17947,-58.53418]}, + {"t":2.76204, "x":5.92634, "y":3.45777, "heading":2.88897, "vx":-0.5858, "vy":-0.9172, "omega":-1.50386, "ax":1.10242, "ay":-3.8418, "alpha":-1.33273, "fx":[14.7925,12.23713,20.24543,22.7318], "fy":[-57.7663,-63.34524,-64.02074,-58.83359]}, + {"t":2.78359, "x":5.91397, "y":3.43712, "heading":2.85657, "vx":-0.56204, "vy":-0.99997, "omega":-1.53257, "ax":1.11162, "ay":-3.83888, "alpha":-1.23864, "fx":[15.13908,12.67162,20.03554,22.74501], "fy":[-58.0943,-62.83509,-63.8652,-58.98566]}, + {"t":2.80513, "x":5.90212, "y":3.41468, "heading":2.82355, "vx":-0.5381, "vy":-1.08267, "omega":-1.55925, "ax":1.12246, "ay":-3.83541, "alpha":-1.17893, "fx":[15.7707,13.04942,19.95606,22.50315], "fy":[-57.79586,-62.80941,-63.75809,-59.19634]}, + {"t":2.82668, "x":5.89079, "y":3.39047, "heading":2.78996, "vx":-0.51391, "vy":-1.1653, "omega":-1.58465, "ax":1.13539, "ay":-3.83122, "alpha":-1.11406, "fx":[16.06187,13.44569,19.88906,22.70429], "fy":[-58.10556,-62.28949,-63.63886,-59.25959]}, + {"t":2.84822, "x":5.87998, "y":3.36447, "heading":2.75582, "vx":-0.48945, "vy":-1.24784, "omega":-1.60865, "ax":1.15112, "ay":-3.82606, "alpha":-1.08517, "fx":[16.69529,13.78799,19.98041,22.63581], "fy":[-57.73393,-62.32692,-63.54152,-59.36335]}, + {"t":2.86976, "x":5.8697, "y":3.3367, "heading":2.72116, "vx":-0.46465, "vy":-1.33027, "omega":-1.63203, "ax":1.17061, "ay":-3.81956, "alpha":-1.0625, "fx":[17.03158,14.13045,20.07155,23.10384], "fy":[-57.88323,-61.89285,-63.45113,-59.32573]}, + {"t":2.89131, "x":5.85997, "y":3.30716, "heading":2.686, "vx":-0.43943, "vy":-1.41256, "omega":-1.65492, "ax":1.19547, "ay":-3.81111, "alpha":-1.06279, "fx":[17.76025,14.52108,20.35111,23.28313], "fy":[-57.38,-61.87425,-63.39829,-59.36382]}, + {"t":2.91285, "x":5.85078, "y":3.27584, "heading":2.65035, "vx":-0.41368, "vy":-1.49467, "omega":-1.67782, "ax":1.22818, "ay":-3.7997, "alpha":-1.07015, "fx":[18.25812,14.95762,20.67651,24.10095], "fy":[-57.41303,-61.32401,-63.33239,-59.22263]}, + {"t":2.9344, "x":5.84215, "y":3.24276, "heading":2.6142, "vx":-0.38722, "vy":-1.57653, "omega":-1.70088, "ax":1.27331, "ay":-3.78344, "alpha":-1.10086, "fx":[19.30523,15.54772,21.34288,24.6633], "fy":[-56.6698,-61.28031,-63.22267,-59.08675]}, + {"t":2.95594, "x":5.8341, "y":3.20791, "heading":2.57756, "vx":-0.35979, "vy":-1.65804, "omega":-1.72459, "ax":1.33914, "ay":-3.7586, "alpha":-1.15787, "fx":[20.32373,16.31426,22.16104,26.24012], "fy":[-56.34425,-60.58062,-63.06772,-58.68974]}, + {"t":2.97748, "x":5.82666, "y":3.17132, "heading":2.5404, "vx":-0.33094, "vy":-1.73901, "omega":-1.74954, "ax":1.44502, "ay":-3.71583, "alpha":-1.22882, "fx":[22.41626,17.77596,23.82988,27.74108], "fy":[-54.84558,-60.17324,-62.7293,-58.21799]}, + {"t":2.99903, "x":5.81987, "y":3.13299, "heading":2.50271, "vx":-0.2998, "vy":-1.81907, "omega":-1.77601, "ax":1.64032, "ay":-3.62735, "alpha":-1.33456, "fx":[25.49437,20.41575,26.575,31.67975], "fy":[-53.52149,-58.29332,-61.79975,-56.73307]}, + {"t":3.02057, "x":5.81379, "y":3.09296, "heading":2.46445, "vx":-0.26446, "vy":-1.89721, "omega":-1.80476, "ax":2.11598, "ay":-3.35425, "alpha":-1.48326, "fx":[33.59778,27.61272,34.1854,38.97523], "fy":[-47.71747,-54.43068,-58.21295,-52.64376]}, + {"t":3.04212, "x":5.80858, "y":3.05131, "heading":2.42557, "vx":-0.21888, "vy":-1.96948, "omega":-1.83672, "ax":3.7259, "ay":-1.14492, "alpha":-1.80113, "fx":[58.90752,52.89572,59.57464,65.22754], "fy":[-11.10029,-18.44735,-25.35752,-17.8007]}, + {"t":3.06366, "x":5.80473, "y":3.00861, "heading":2.38599, "vx":-0.13861, "vy":-1.99414, "omega":-1.87552, "ax":3.37427, "ay":-0.17803, "alpha":-2.1349, "fx":[53.52541,45.99487,55.06403,59.69155], "fy":[5.99487,-2.47623,-11.69574,-3.1285]}, + {"t":3.0852, "x":5.80253, "y":2.96561, "heading":2.34559, "vx":-0.06591, "vy":-1.99798, "omega":-1.92152, "ax":-3.74217, "ay":0.20055, "alpha":-2.27211, "fx":[-59.82217,-66.64515,-59.30921,-51.86213], "fy":[12.41872,3.97184,-6.22534,2.57009]}, + {"t":3.10675, "x":5.80024, "y":2.92261, "heading":2.30419, "vx":-0.14653, "vy":-1.99366, "omega":-1.97047, "ax":-3.88967, "ay":0.43378, "alpha":-2.42985, "fx":[-61.81439,-69.19284,-62.47543,-53.52301], "fy":[16.90556,7.59397,-3.20418,6.25083]}, + {"t":3.12829, "x":5.79618, "y":2.87976, "heading":2.26174, "vx":-0.23033, "vy":-1.98431, "omega":-2.02282, "ax":-3.74904, "ay":0.42531, "alpha":-1.94294, "fx":[-59.25529,-65.5748,-60.02513,-53.2199], "fy":[14.80797,7.81225,-1.27611,5.66419]}, + {"t":3.14159, "x":5.79279, "y":2.85342, "heading":2.23485, "vx":-0.28017, "vy":-1.97866, "omega":-2.04864, "ax":-3.80971, "ay":0.58632, "alpha":-1.79377, "fx":[-60.31671,-66.11742,-61.44009,-54.05354], "fy":[16.32919,10.42173,2.17599,8.30613]}, + {"t":3.15488, "x":5.78873, "y":2.82717, "heading":2.20762, "vx":-0.33081, "vy":-1.97087, "omega":-2.07249, "ax":-3.75142, "ay":0.67758, "alpha":-1.53214, "fx":[-58.95146,-64.25637,-60.3087,-54.70939], "fy":[17.16646,11.75904,4.4217,9.68106]}, + {"t":3.16817, "x":5.784, "y":2.80103, "heading":2.18007, "vx":-0.38068, "vy":-1.96186, "omega":-2.09285, "ax":-3.67173, "ay":0.75921, "alpha":-1.49863, "fx":[-57.93144,-63.12904,-59.42362,-52.68175], "fy":[17.61775,13.28698,6.31608,10.99115]}, + {"t":3.18146, "x":5.77861, "y":2.77502, "heading":2.15225, "vx":-0.42949, "vy":-1.95177, "omega":-2.11278, "ax":-3.55869, "ay":0.82789, "alpha":-1.25899, "fx":[-55.73482,-60.43628,-57.34671,-52.46965], "fy":[18.32619,14.08197,8.11222,12.05302]}, + {"t":3.19476, "x":5.77259, "y":2.74915, "heading":2.12416, "vx":-0.47679, "vy":-1.94076, "omega":-2.12951, "ax":-3.31396, "ay":0.85372, "alpha":-1.25603, "fx":[-52.15254,-56.85122,-53.80212,-47.64046], "fy":[17.85079,14.90299,9.01375,12.44598]}, + {"t":3.20805, "x":5.76596, "y":2.72342, "heading":2.09586, "vx":-0.52084, "vy":-1.92941, "omega":-2.14621, "ax":-3.13172, "ay":0.88142, "alpha":-1.03332, "fx":[-48.90298,-53.06572,-50.57804,-46.32675], "fy":[18.1232,14.86488,10.07323,12.91119]}, + {"t":3.22134, "x":5.75876, "y":2.69785, "heading":2.06733, "vx":-0.56247, "vy":-1.9177, "omega":-2.15994, "ax":-2.20201, "ay":0.66447, "alpha":-0.99494, "fx":[-34.33768,-38.38711,-35.98947,-31.11972], "fy":[13.85618,11.86527,7.0499,9.42442]}, + {"t":3.23464, "x":5.75109, "y":2.67242, "heading":2.03861, "vx":-0.59175, "vy":-1.90886, "omega":-2.17317, "ax":-2.06677, "ay":0.65583, "alpha":-0.82289, "fx":[-32.0252,-35.55468,-33.61597,-30.05022], "fy":[13.52947,11.31866,7.44365,9.35509]}, + {"t":3.24793, "x":5.74304, "y":2.6471, "heading":2.00973, "vx":-0.61922, "vy":-1.90015, "omega":-2.18411, "ax":-1.29167, "ay":0.42786, "alpha":-0.7218, "fx":[-19.84113,-22.95235,-21.32361,-17.90756], "fy":[9.22568,7.8905,4.26831,5.78582]}, + {"t":3.26122, "x":5.73469, "y":2.62188, "heading":1.98069, "vx":-0.63639, "vy":-1.89446, "omega":-2.1937, "ax":-1.01262, "ay":0.34406, "alpha":-0.58675, "fx":[-15.40744,-18.01542,-16.75057,-14.1306], "fy":[7.55348,6.34699,3.39516,4.55313]}, + {"t":3.27452, "x":5.72614, "y":2.59673, "heading":1.95153, "vx":-0.64985, "vy":-1.88989, "omega":-2.2015, "ax":-0.73355, "ay":0.25418, "alpha":-0.46529, "fx":[-11.08765,-13.16363,-12.22729,-10.10418], "fy":[5.65058,4.81134,2.41592,3.26344]}, + {"t":3.28781, "x":5.71744, "y":2.57163, "heading":1.92227, "vx":-0.6596, "vy":-1.88651, "omega":-2.20769, "ax":-0.40484, "ay":0.14259, "alpha":-0.34661, "fx":[-5.96805,-7.53721,-6.88767,-5.3158], "fy":[3.40725,2.95859,1.0576,1.63154]}, + {"t":3.3011, "x":5.70864, "y":2.54657, "heading":1.89292, "vx":-0.66498, "vy":-1.88461, "omega":-2.2123, "ax":-0.41006, "ay":0.14499, "alpha":-0.22284, "fx":[-6.18295,-7.19097,-6.8095,-5.85628], "fy":[3.12845,2.68507,1.52677,1.86704]}, + {"t":3.31439, "x":5.69976, "y":2.52153, "heading":1.86351, "vx":-0.67043, "vy":-1.88268, "omega":-2.21526, "ax":-0.10568, "ay":0.03802, "alpha":-0.10949, "fx":[-1.51782,-2.00452,-1.8377,-1.35074], "fy":[0.88767,0.95319,0.21656,0.35711]}, + {"t":3.32769, "x":5.69084, "y":2.4965, "heading":1.83406, "vx":-0.67184, "vy":-1.88218, "omega":-2.21671, "ax":-0.22662, "ay":0.08085, "alpha":0.01413, "fx":[-3.61013,-3.51979,-3.54687,-3.71434], "fy":[1.33714,1.20436,1.30856,1.28431]}, + {"t":3.34098, "x":5.68189, "y":2.47149, "heading":1.8046, "vx":-0.67485, "vy":-1.8811, "omega":-2.21653, "ax":0.02126, "ay":-0.00747, "alpha":0.12923, "fx":[0.10368,0.7442,0.57127,-0.06892], "fy":[-0.63052,-0.25034,0.28192,0.12433]}, + {"t":3.35427, "x":5.67292, "y":2.44649, "heading":1.77513, "vx":-0.67457, "vy":-1.8812, "omega":-2.21481, "ax":-0.12314, "ay":0.04414, "alpha":0.25513, "fx":[-2.41463,-1.17182,-1.46461,-2.76884], "fy":[-0.01218,0.07476,1.49928,1.24111]}, + {"t":3.36757, "x":5.66394, "y":2.42148, "heading":1.74569, "vx":-0.67621, "vy":-1.88062, "omega":-2.21142, "ax":0.0586, "ay":-0.02105, "alpha":0.37776, "fx":[0.19517,2.03476,1.66495,-0.17371], "fy":[-1.60807,-1.07604,0.83762,0.50974]}, + {"t":3.38086, "x":5.65496, "y":2.39648, "heading":1.7163, "vx":-0.67543, "vy":-1.8809, "omega":-2.20639, "ax":-0.06346, "ay":0.02281, "alpha":0.50997, "fx":[-2.03449,0.44884,0.03418,-2.47838], "fy":[-1.12,-0.91818,1.92571,1.56126]}, + {"t":3.39415, "x":5.64597, "y":2.37148, "heading":1.68697, "vx":-0.67627, "vy":-1.88059, "omega":-2.19962, "ax":0.0485, "ay":-0.01746, "alpha":0.64584, "fx":[-0.59502,2.55294,2.13431,-1.01213], "fy":[-2.30514,-1.76815,1.66637,1.29806]}, + {"t":3.40745, "x":5.63699, "y":2.34648, "heading":1.65773, "vx":-0.67563, "vy":-1.88082, "omega":-2.19103, "ax":-0.02704, "ay":0.00969, "alpha":0.78973, "fx":[-2.16569,1.68677,1.30347,-2.54196], "fy":[-2.11796,-1.916,2.49262,2.15667]}, + {"t":3.42074, "x":5.628, "y":2.32148, "heading":1.6286, "vx":-0.67599, "vy":-1.8807, "omega":-2.18053, "ax":-0.00003, "ay":0.00038, "alpha":0.94373, "fx":[-2.15279,2.45551,2.14978,-2.45467], "fy":[-2.7902,-2.39016,2.73508,2.46934]}, + {"t":3.43403, "x":5.61902, "y":2.29648, "heading":1.59962, "vx":-0.67599, "vy":-1.88069, "omega":-2.16799, "ax":0.00453, "ay":0.11766, "alpha":1.10687, "fx":[-2.54152,2.86602,2.67984,-2.71695], "fy":[-1.3154,-1.05534,4.99651,4.84628]}, + {"t":3.44732, "x":5.61003, "y":2.27149, "heading":1.5708, "vx":-0.67593, "vy":-1.87913, "omega":-2.15327, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + "splits":[0] + }, + "events":[ + {"name":"IntakeDown", "from":{"target":0, "targetTimestamp":0.0, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeDown"}}}, + {"name":"IntakeUp", "from":{"target":3, "targetTimestamp":3.12829, "offset":{"exp":"0 s", "val":0.0}}, "event":{"type":"named", "data":{"name":"IntakeUp"}}}] +} diff --git a/src/main/deploy/choreo/RightShoot.traj b/src/main/deploy/choreo/RightShoot.traj index 7c763f8e..660d258a 100644 --- a/src/main/deploy/choreo/RightShoot.traj +++ b/src/main/deploy/choreo/RightShoot.traj @@ -3,26 +3,28 @@ "version":3, "snapshot":{ "waypoints":[ - {"x":3.5869221687316895, "y":2.4568724632263184, "heading":1.5707963267948966, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":3.2106049060821533, "y":3.1112046241760254, "heading":-2.5417152273121077, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":3.5869221687316895, "y":2.4568724632263184, "heading":1.5707963267948966, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.3642568588256836, "y":2.448859214782715, "heading":-2.1975393825258824, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":5.0}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":6.0}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":6.0}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":5.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"3.5869221687316895 m", "val":3.5869221687316895}, "y":{"exp":"2.4568724632263184 m", "val":2.4568724632263184}, "heading":{"exp":"90 deg", "val":1.5707963267948966}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, - {"x":{"exp":"3.2106049060821533 m", "val":3.2106049060821533}, "y":{"exp":"3.1112046241760254 m", "val":3.1112046241760254}, "heading":{"exp":"-2.5417152273121077 rad", "val":-2.5417152273121077}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], + {"x":{"exp":"3.5869221687316895 m", "val":3.5869221687316895}, "y":{"exp":"2.4568724632263184 m", "val":2.4568724632263184}, "heading":{"exp":"90 deg", "val":1.5707963267948966}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.3642568588256836 m", "val":3.3642568588256836}, "y":{"exp":"2.448859214782715 m", "val":2.448859214782715}, "heading":{"exp":"-2.1975393825258824 rad", "val":-2.1975393825258824}, "intervals":27, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":{"exp":"5 m / s", "val":5.0}}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"6 m / s ^ 2", "val":6.0}}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"6 m / s ^ 2", "val":6.0}}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"5 rad / s", "val":5.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -53,36 +55,40 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,0.71015], + "waypoints":[0.0,0.64113], "samples":[ - {"t":0.0, "x":3.58692, "y":2.45687, "heading":1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-2.9831, "ay":5.20023, "alpha":17.21909, "fx":[-128.30019,18.75035,1.41604,-81.30183], "fy":[14.29683,82.67586,130.24509,103.01226]}, - {"t":0.0263, "x":3.58589, "y":2.45867, "heading":1.5708, "vx":-0.07846, "vy":0.13678, "omega":0.45289, "ax":-2.98502, "ay":5.20172, "alpha":17.07128, "fx":[-127.71814,16.75789,2.06098,-80.65818], "fy":[14.89035,82.45199,129.85906,103.12289]}, - {"t":0.0526, "x":3.58279, "y":2.46407, "heading":1.58271, "vx":-0.15697, "vy":0.27359, "omega":0.9019, "ax":-2.98473, "ay":5.2016, "alpha":16.96083, "fx":[-127.07086,17.36086,1.12219,-80.9514], "fy":[15.27785,83.14437,129.45208,102.44278]}, - {"t":0.07891, "x":3.57763, "y":2.47306, "heading":1.60643, "vx":-0.23548, "vy":0.4104, "omega":1.348, "ax":-2.98482, "ay":5.20122, "alpha":16.87441, "fx":[-126.35805,19.29576,-0.90041,-81.58202], "fy":[14.98492,84.86753,129.01426,101.42599]}, - {"t":0.10521, "x":3.57041, "y":2.48566, "heading":1.64188, "vx":-0.31398, "vy":0.5472, "omega":1.79182, "ax":-2.98424, "ay":5.20114, "alpha":16.79897, "fx":[-125.449,22.31478,-3.54432,-82.82927], "fy":[14.71372,87.34977,128.44946,99.77496]}, - {"t":0.13151, "x":3.56112, "y":2.50185, "heading":1.68901, "vx":-0.39247, "vy":0.684, "omega":2.23366, "ax":-2.98461, "ay":5.20042, "alpha":16.72147, "fx":[-124.19663,25.54704,-6.73615,-84.14581], "fy":[14.39983,90.1757,127.7633,97.90294]}, - {"t":0.15781, "x":3.54976, "y":2.52164, "heading":1.74776, "vx":-0.47097, "vy":0.82078, "omega":2.67347, "ax":-2.98534, "ay":5.19934, "alpha":16.58358, "fx":[-122.30671,28.45429,-10.22547,-85.49983], "fy":[14.79588,92.85968,126.81937,95.69854]}, - {"t":0.18411, "x":3.53634, "y":2.54502, "heading":1.81808, "vx":-0.54949, "vy":0.95753, "omega":3.10964, "ax":-2.98737, "ay":5.1973, "alpha":16.32996, "fx":[-119.35054,30.29118,-14.03365,-86.61372], "fy":[15.79288,95.26015,125.61867,93.37182]}, - {"t":0.21041, "x":3.52086, "y":2.57201, "heading":1.89987, "vx":-0.62806, "vy":1.09423, "omega":3.53915, "ax":-2.99049, "ay":5.19427, "alpha":15.82768, "fx":[-114.48359,30.4688,-18.14307,-87.74733], "fy":[18.22688,97.27408,123.93829,90.41188]}, - {"t":0.23672, "x":3.5033, "y":2.60258, "heading":1.99295, "vx":-0.70672, "vy":1.23085, "omega":3.95545, "ax":-2.99217, "ay":5.19145, "alpha":14.97999, "fx":[-107.18617,28.14129,-22.76222,-88.2044], "fy":[22.19089,98.51132,121.63099,87.33896]}, - {"t":0.26302, "x":3.48368, "y":2.63675, "heading":2.09699, "vx":-0.78542, "vy":1.36739, "omega":4.34945, "ax":-2.99628, "ay":5.18597, "alpha":13.5914, "fx":[-96.2386,22.37412,-28.36286,-88.04535], "fy":[28.75258,98.9292,118.14839,83.49413]}, - {"t":0.28932, "x":3.46199, "y":2.67451, "heading":2.21139, "vx":-0.86423, "vy":1.50379, "omega":4.70692, "ax":-3.0162, "ay":5.16811, "alpha":11.49808, "fx":[-81.53996,10.82136,-34.80658,-86.0126], "fy":[37.94057,97.57354,113.16778,79.50797]}, - {"t":0.31562, "x":3.43821, "y":2.71585, "heading":2.33519, "vx":-0.94356, "vy":1.63972, "omega":5.00934, "ax":-3.00847, "ay":5.15305, "alpha":9.22204, "fx":[-62.79354,-3.31512,-42.91531,-82.02296], "fy":[46.98647,95.18001,107.01147,78.05604]}, - {"t":0.34192, "x":3.41235, "y":2.76076, "heading":2.46694, "vx":-1.02269, "vy":1.77526, "omega":5.2519, "ax":0.00934, "ay":0.0093, "alpha":4.92633, "fx":[3.40804,18.36715,-3.15512,-18.02701], "fy":[-17.66423,1.02824,17.91458,-0.68823]}, - {"t":0.36822, "x":3.38546, "y":2.80746, "heading":2.60507, "vx":-1.02244, "vy":1.7755, "omega":5.38147, "ax":2.98288, "ay":-5.16848, "alpha":-5.0832, "fx":[46.75108,24.02222,49.56455,69.08365], "fy":[-66.37167,-92.05823,-94.47082,-75.31284]}, - {"t":0.39453, "x":3.3596, "y":2.85237, "heading":2.74662, "vx":-0.94399, "vy":1.63956, "omega":5.24777, "ax":3.01122, "ay":-5.17115, "alpha":-8.8221, "fx":[44.26926,4.4893,55.04053,87.42234], "fy":[-61.6368,-103.44358,-99.56797,-63.7348]}, - {"t":0.42083, "x":3.33581, "y":2.8937, "heading":2.88464, "vx":-0.86479, "vy":1.50355, "omega":5.01574, "ax":2.98906, "ay":-5.19021, "alpha":-11.40067, "fx":[31.21762,-4.63997,63.39687,99.83936], "fy":[-63.75105,-111.80529,-100.55908,-53.47813]}, - {"t":0.44713, "x":3.3141, "y":2.93145, "heading":3.01656, "vx":-0.78617, "vy":1.36704, "omega":4.71588, "ax":2.98637, "ay":-5.19483, "alpha":-13.29451, "fx":[13.77339,-5.5477,72.40881,109.00865], "fy":[-71.51502,-117.40512,-98.44667,-42.52029]}, - {"t":0.47343, "x":3.29446, "y":2.96561, "heading":3.1406, "vx":-0.70762, "vy":1.23041, "omega":4.36621, "ax":2.98346, "ay":-5.19834, "alpha":-14.90543, "fx":[-5.17732,-1.59292,81.04023,115.18826], "fy":[-81.61322,-121.28754,-94.58349,-32.62572]}, - {"t":0.49973, "x":3.27688, "y":2.99617, "heading":-3.02775, "vx":-0.62915, "vy":1.09368, "omega":3.97417, "ax":2.98227, "ay":-5.20025, "alpha":-16.32157, "fx":[-21.09505,3.4487,87.96581,119.06319], "fy":[-91.29588,-123.91463,-90.45639,-24.56406]}, - {"t":0.52603, "x":3.26136, "y":3.02314, "heading":-2.92322, "vx":-0.55071, "vy":0.95691, "omega":3.54488, "ax":2.9824, "ay":-5.20104, "alpha":-17.49713, "fx":[-32.83295,7.88145,93.09315,121.24968], "fy":[-98.97966,-125.59094,-86.87649,-18.83428]}, - {"t":0.55234, "x":3.24791, "y":3.04651, "heading":-2.82998, "vx":-0.47227, "vy":0.82011, "omega":3.08468, "ax":2.98471, "ay":-5.20037, "alpha":-18.41475, "fx":[-40.9812,11.3306,96.77408,122.41448], "fy":[-104.56501,-126.71103,-84.0227,-14.94006]}, - {"t":0.57864, "x":3.23652, "y":3.06628, "heading":-2.74885, "vx":-0.39377, "vy":0.68333, "omega":2.60034, "ax":2.98776, "ay":-5.19913, "alpha":-19.09316, "fx":[-46.45454,13.80373,99.34796,123.03413], "fy":[-108.29551,-127.52667,-81.97863,-12.35926]}, - {"t":0.60494, "x":3.22719, "y":3.08246, "heading":-2.68046, "vx":-0.31518, "vy":0.54658, "omega":2.09816, "ax":2.9916, "ay":-5.19733, "alpha":-19.56634, "fx":[-50.18272,15.59067,101.18981,123.37787], "fy":[-110.71085,-128.13225,-80.50044,-10.70186]}, - {"t":0.63124, "x":3.21994, "y":3.09503, "heading":-2.62527, "vx":-0.2365, "vy":0.40989, "omega":1.58353, "ax":2.99497, "ay":-5.19572, "alpha":-19.87392, "fx":[-52.61882,16.79272,102.49479,123.52075], "fy":[-112.17813,-128.609,-79.50396,-9.65232]}, - {"t":0.65754, "x":3.21475, "y":3.10402, "heading":-2.58362, "vx":-0.15773, "vy":0.27323, "omega":1.06081, "ax":2.99753, "ay":-5.19452, "alpha":-20.08739, "fx":[-54.39558,17.57174,103.3935,123.78203], "fy":[-113.01368,-129.00262,-78.92182,-8.92936]}, - {"t":0.68384, "x":3.21164, "y":3.10941, "heading":-2.55572, "vx":-0.07889, "vy":0.1366, "omega":0.53248, "ax":2.99929, "ay":-5.19374, "alpha":-20.24495, "fx":[-55.7937,18.14522,104.02097,124.0912], "fy":[-113.48485,-129.3196,-78.61998,-8.39335]}, - {"t":0.71015, "x":3.2106, "y":3.1112, "heading":-2.54172, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":3.58692, "y":2.45687, "heading":1.5708, "vx":0.0, "vy":0.0, "omega":0.0, "ax":-0.20729, "ay":-0.00346, "alpha":36.50204, "fx":[-91.63546,85.05154,85.17919,-91.75858], "fy":[-98.573,-104.28633,104.18154,98.45789]}, + {"t":0.02068, "x":3.58688, "y":2.45687, "heading":1.5708, "vx":-0.00429, "vy":-0.00007, "omega":0.75492, "ax":-0.23127, "ay":-0.00387, "alpha":36.48239, "fx":[-91.93951,84.59277,84.73646,-92.07602], "fy":[-98.21767,-104.5846,104.46747,98.08905]}, + {"t":0.04136, "x":3.58674, "y":2.45687, "heading":1.58641, "vx":-0.00907, "vy":-0.00015, "omega":1.50943, "ax":-0.26674, "ay":-0.00548, "alpha":36.45233, "fx":[-90.90175,85.59383,82.36518,-93.99629], "fy":[-99.074,-103.65477,106.23808,96.14276]}, + {"t":0.06204, "x":3.5865, "y":2.45687, "heading":1.61763, "vx":-0.01459, "vy":-0.00026, "omega":2.26332, "ax":-0.32417, "ay":-0.00909, "alpha":36.4009, "fx":[-88.6553,87.84456,77.72652,-97.50146], "fy":[-100.92235,-101.56425,109.50333,92.40605]}, + {"t":0.08273, "x":3.58612, "y":2.45686, "heading":1.66444, "vx":-0.02129, "vy":-0.00045, "omega":3.01615, "ax":-0.43707, "ay":-0.01612, "alpha":36.29239, "fx":[-85.65632,90.71708,69.77657,-102.59245], "fy":[-103.17062,-98.61866,114.40709,86.35827]}, + {"t":0.10341, "x":3.58559, "y":2.45684, "heading":1.72681, "vx":-0.03033, "vy":-0.00079, "omega":3.76673, "ax":-0.7438, "ay":-0.04405, "alpha":35.93817, "fx":[-83.8916,91.70367,54.66564,-109.7111], "fy":[-103.80905,-96.54605,121.48641,76.07107]}, + {"t":0.12409, "x":3.5848, "y":2.45682, "heading":1.80472, "vx":-0.04571, "vy":-0.0017, "omega":4.50998, "ax":-4.94111, "ay":-0.53173, "alpha":23.55581, "fx":[-108.07673,-24.40234,-59.21015,-122.08583], "fy":[-68.09106,-113.57234,108.06273,39.8343]}, + {"t":0.14477, "x":3.5828, "y":2.45667, "heading":1.89799, "vx":-0.1479, "vy":-0.01269, "omega":4.99715, "ax":-5.74937, "ay":-0.14408, "alpha":0.01968, "fx":[-90.82099,-92.34333,-91.98576,-89.95191], "fy":[-1.65503,-5.11337,-0.23202,-2.1493]}, + {"t":0.16545, "x":3.57851, "y":2.45638, "heading":2.00134, "vx":-0.26681, "vy":-0.01567, "omega":4.99756, "ax":-5.70469, "ay":-0.15383, "alpha":-0.00003, "fx":[-90.57929,-90.68745,-90.64148,-90.35621], "fy":[-2.66141,-2.39319,-2.3343,-2.37947]}, + {"t":0.18613, "x":3.57178, "y":2.45602, "heading":2.10469, "vx":-0.38479, "vy":-0.01886, "omega":4.99756, "ax":-5.63974, "ay":-0.14116, "alpha":-0.00001, "fx":[-89.53194,-89.55197,-89.53934,-89.51678], "fy":[-2.24089,-2.29089,-2.23586,-2.19627]}, + {"t":0.20682, "x":3.56261, "y":2.4556, "heading":2.20805, "vx":-0.50143, "vy":-0.02178, "omega":4.99756, "ax":-5.54616, "ay":-0.15794, "alpha":0.00001, "fx":[-88.15227,-88.14508,-88.15942,-87.74038], "fy":[-2.73725,-2.49178,-2.34837,-2.45215]}, + {"t":0.2275, "x":3.55105, "y":2.45512, "heading":2.31141, "vx":-0.61613, "vy":-0.02504, "omega":4.99756, "ax":-5.38518, "ay":-0.12499, "alpha":0.0, "fx":[-85.49448,-85.51205,-85.4938,-85.47456], "fy":[-2.00307,-1.98516,-1.96606,-1.98304]}, + {"t":0.24818, "x":3.53716, "y":2.45457, "heading":2.41477, "vx":-0.72751, "vy":-0.02763, "omega":4.99756, "ax":-4.57691, "ay":-0.12438, "alpha":-0.00001, "fx":[-72.96572,-72.67973,-73.04994,-71.95173], "fy":[-2.30228,-2.01197,-1.57936,-2.00519]}, + {"t":0.26886, "x":3.52114, "y":2.45397, "heading":2.51812, "vx":-0.82216, "vy":-0.0302, "omega":4.99756, "ax":-4.4439, "ay":-0.07323, "alpha":0.00001, "fx":[-70.54237,-70.50281,-70.55827,-70.59713], "fy":[-1.11948,-1.14388,-1.22158,-1.16524]}, + {"t":0.28954, "x":3.50318, "y":2.45333, "heading":2.62148, "vx":-0.91407, "vy":-0.03171, "omega":4.99756, "ax":-1.58383, "ay":-0.02384, "alpha":-0.00001, "fx":[-25.26456,-25.13437,-25.39534,-24.78345], "fy":[-0.50901,-0.35865,-0.20706,-0.43911]}, + {"t":0.31022, "x":3.48394, "y":2.45267, "heading":2.72484, "vx":-0.94683, "vy":-0.03221, "omega":4.99756, "ax":0.19504, "ay":0.03314, "alpha":0.0, "fx":[3.09954,3.10377,3.09317,3.08895], "fy":[0.53507,0.51998,0.51973,0.52986]}, + {"t":0.3309, "x":3.4644, "y":2.45201, "heading":2.8282, "vx":-0.94279, "vy":-0.03152, "omega":4.99756, "ax":1.85983, "ay":0.08882, "alpha":0.00001, "fx":[29.62329,29.54656,29.82031,29.11442], "fy":[1.53073,1.34832,1.25731,1.50406]}, + {"t":0.35159, "x":3.4453, "y":2.45138, "heading":2.93155, "vx":-0.90433, "vy":-0.02968, "omega":4.99756, "ax":4.57168, "ay":0.12402, "alpha":0.0, "fx":[72.56161,72.55402,72.59546,72.60389], "fy":[1.94164,1.96105,2.01778,1.9552]}, + {"t":0.37227, "x":3.42757, "y":2.45079, "heading":3.03491, "vx":-0.80978, "vy":-0.02712, "omega":4.99756, "ax":4.74278, "ay":0.17559, "alpha":0.00001, "fx":[75.45243,75.42791,75.7628,74.53721], "fy":[2.97745,2.61557,2.56561,2.99215]}, + {"t":0.39295, "x":3.41184, "y":2.45027, "heading":3.13827, "vx":-0.71169, "vy":-0.02349, "omega":4.99756, "ax":5.40925, "ay":0.14831, "alpha":0.0, "fx":[85.89479,85.8993,85.85451,85.85483], "fy":[2.37913,2.24801,2.41215,2.37863]}, + {"t":0.41363, "x":3.39828, "y":2.44982, "heading":-3.04156, "vx":-0.59982, "vy":-0.02042, "omega":4.99756, "ax":5.55961, "ay":0.18032, "alpha":-0.00001, "fx":[88.35004,88.36151,88.36229,87.97771], "fy":[3.0165,2.74606,2.78225,2.90599]}, + {"t":0.43431, "x":3.38706, "y":2.44943, "heading":-2.9382, "vx":-0.48484, "vy":-0.01669, "omega":4.99756, "ax":5.64907, "ay":0.14848, "alpha":0.00001, "fx":[89.71365,89.70992,89.64863,89.6602], "fy":[2.36624,2.21397,2.46492,2.38364]}, + {"t":0.45499, "x":3.37824, "y":2.44912, "heading":-2.83485, "vx":-0.36801, "vy":-0.01362, "omega":4.99756, "ax":5.71085, "ay":0.16081, "alpha":0.00006, "fx":[90.76357,90.75545,90.6417,90.49509], "fy":[2.73735,2.37963,2.52621,2.56874]}, + {"t":0.47568, "x":3.37185, "y":2.44887, "heading":-2.73149, "vx":-0.2499, "vy":-0.01029, "omega":4.99756, "ax":5.75426, "ay":0.1406, "alpha":-0.02133, "fx":[92.7849,92.24207,89.67166,90.7136], "fy":[4.30456,-1.28173,3.20184,2.70393]}, + {"t":0.49636, "x":3.36792, "y":2.44869, "heading":-2.62813, "vx":-0.13089, "vy":-0.00739, "omega":4.99712, "ax":4.40376, "ay":0.5603, "alpha":-23.48289, "fx":[-20.85605,68.69324,128.3529,103.46143], "fy":[79.06527,-104.64724,-13.99534,75.15814]}, + {"t":0.51704, "x":3.36615, "y":2.44865, "heading":-2.52478, "vx":-0.03981, "vy":0.0042, "omega":4.51146, "ax":0.62125, "ay":-0.06013, "alpha":-35.98348, "fx":[-132.07149,-10.87221,133.07304,49.3221], "fy":[16.40364,-132.86892,-11.32893,123.97577]}, + {"t":0.53772, "x":3.36546, "y":2.44873, "heading":-2.43148, "vx":-0.02697, "vy":0.00296, "omega":3.76726, "ax":0.37665, "ay":-0.04172, "alpha":-36.30527, "fx":[-133.96615,-6.91811,134.11931,30.68317], "fy":[1.45397,-133.86702,-0.74732,130.51087]}, + {"t":0.5584, "x":3.36498, "y":2.44878, "heading":-2.35357, "vx":-0.01918, "vy":0.00209, "omega":3.01642, "ax":0.2864, "ay":-0.03218, "alpha":-36.40674, "fx":[-133.90816,0.41446,134.04538,17.63562], "fy":[-9.8598,-134.30793,8.9722,133.15207]}, + {"t":0.57908, "x":3.36465, "y":2.44882, "heading":-2.29118, "vx":-0.01325, "vy":0.00143, "omega":2.26347, "ax":0.23976, "ay":-0.0265, "alpha":-36.45574, "fx":[-133.12451,7.17966,133.39153,7.77903], "fy":[-18.60937,-134.25162,16.95889,134.2193]}, + {"t":0.59976, "x":3.36442, "y":2.44884, "heading":-2.24437, "vx":-0.00829, "vy":0.00088, "omega":1.50951, "ax":0.21053, "ay":-0.02264, "alpha":-36.48464, "fx":[-132.15961,12.45671,132.55773,0.51425], "fy":[-25.02379,-133.94746,23.00999,134.52369]}, + {"t":0.62045, "x":3.3643, "y":2.44885, "heading":-2.21315, "vx":-0.00394, "vy":0.00041, "omega":0.75495, "ax":0.19051, "ay":-0.01997, "alpha":-36.50364, "fx":[-131.35643,15.96549,131.84018,-4.35144], "fy":[-29.21939,-133.63011,27.07252,134.50877]}, + {"t":0.64113, "x":3.36426, "y":2.44886, "heading":-2.19754, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[] diff --git a/src/main/deploy/choreo/RightShootToBump.traj b/src/main/deploy/choreo/RightShootToBump.traj index 17e78de8..47390875 100644 --- a/src/main/deploy/choreo/RightShootToBump.traj +++ b/src/main/deploy/choreo/RightShootToBump.traj @@ -3,26 +3,30 @@ "version":3, "snapshot":{ "waypoints":[ - {"x":3.2106049060821533, "y":3.1112046241760254, "heading":-2.5417152273121077, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.3642568588256836, "y":2.448859214782715, "heading":-2.1975393825258824, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":3.60064959526062, "y":2.3620588779449463, "heading":1.57, "intervals":0, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":3.60064959526062, "y":2.3620588779449463, "heading":1.57, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":0.0, "y":0.0, "w":16.541, "h":8.0692}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":5.0}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":8.0}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":5.0}}, "enabled":true}], "targetDt":0.05 }, "params":{ "waypoints":[ - {"x":{"exp":"3.2106049060821533 m", "val":3.2106049060821533}, "y":{"exp":"3.1112046241760254 m", "val":3.1112046241760254}, "heading":{"exp":"-2.5417152273121077 rad", "val":-2.5417152273121077}, "intervals":26, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.3642568588256836 m", "val":3.3642568588256836}, "y":{"exp":"2.448859214782715 m", "val":2.448859214782715}, "heading":{"exp":"-2.1975393825258824 rad", "val":-2.1975393825258824}, "intervals":31, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, + {"x":{"exp":"3.60064959526062 m", "val":3.60064959526062}, "y":{"exp":"2.3620588779449463 m", "val":2.3620588779449463}, "heading":{"exp":"3.14 / 2 rad", "val":1.57}, "intervals":0, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}, {"x":{"exp":"3.60064959526062 m", "val":3.60064959526062}, "y":{"exp":"2.3620588779449463 m", "val":2.3620588779449463}, "heading":{"exp":"3.14 / 2 rad", "val":1.57}, "intervals":20, "split":false, "fixTranslation":true, "fixHeading":true, "overrideIntervals":false}], "constraints":[ {"from":"first", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"last", "to":null, "data":{"type":"StopPoint", "props":{}}, "enabled":true}, {"from":"first", "to":"last", "data":{"type":"KeepInRectangle", "props":{"x":{"exp":"0 m", "val":0.0}, "y":{"exp":"0 m", "val":0.0}, "w":{"exp":"16.541 m", "val":16.541}, "h":{"exp":"8.0692 m", "val":8.0692}}}, "enabled":false}, {"from":"first", "to":"last", "data":{"type":"MaxVelocity", "props":{"max":{"exp":"5 m / s", "val":5.0}}}, "enabled":true}, - {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"8 m / s ^ 2", "val":8.0}}}, "enabled":true}], + {"from":"first", "to":"last", "data":{"type":"MaxAcceleration", "props":{"max":{"exp":"8 m / s ^ 2", "val":8.0}}}, "enabled":true}, + {"from":0, "to":1, "data":{"type":"MaxAngularVelocity", "props":{"max":{"exp":"5 rad / s", "val":5.0}}}, "enabled":true}], "targetDt":{ "exp":"0.05 s", "val":0.05 @@ -53,35 +57,40 @@ "differentialTrackWidth":0.5588 }, "sampleType":"Swerve", - "waypoints":[0.0,0.70735], + "waypoints":[0.0,0.64126,0.64126], "samples":[ - {"t":0.0, "x":3.2106, "y":3.1112, "heading":-2.54172, "vx":0.0, "vy":0.0, "omega":0.0, "ax":3.48898, "ay":-5.73373, "alpha":-18.79305, "fx":[-43.52614,25.19356,107.39163,132.50128], "fy":[-127.32267,-132.33283,-81.31604,-23.13721]}, - {"t":0.02721, "x":3.2119, "y":3.10908, "heading":-2.54172, "vx":0.09492, "vy":-0.15599, "omega":-0.51128, "ax":3.49209, "ay":-5.7387, "alpha":-18.75246, "fx":[-43.27363,25.25562,107.35042,132.4254], "fy":[-127.38037,-132.30728,-81.34739,-23.38955]}, - {"t":0.05441, "x":3.21577, "y":3.10272, "heading":-2.55563, "vx":0.18993, "vy":-0.31212, "omega":-1.02146, "ax":3.46412, "ay":-5.74532, "alpha":-18.80041, "fx":[-43.76561,24.44266,106.89911,132.4058], "fy":[-127.17236,-132.44269,-81.91274,-23.31672]}, - {"t":0.08162, "x":3.22222, "y":3.0921, "heading":-2.58341, "vx":0.28417, "vy":-0.46842, "omega":-1.53294, "ax":3.40985, "ay":-5.76357, "alpha":-18.86791, "fx":[-44.62756,22.83278,105.97215,132.35805], "fy":[-126.81775,-132.70821,-83.0774,-23.40007]}, - {"t":0.10882, "x":3.23121, "y":3.07722, "heading":-2.62512, "vx":0.37694, "vy":-0.62523, "omega":-2.04626, "ax":3.32992, "ay":-5.79565, "alpha":-18.92817, "fx":[-45.75835,20.42651,104.53851,132.25276], "fy":[-126.33758,-133.07234,-84.83744,-23.79363]}, - {"t":0.13603, "x":3.2427, "y":3.05807, "heading":-2.68079, "vx":0.46753, "vy":-0.7829, "omega":-2.56122, "ax":3.22599, "ay":-5.84461, "alpha":-18.94024, "fx":[-46.96484,17.22544,102.55171,132.04754], "fy":[-125.78368,-133.48826,-87.18357,-24.69433]}, - {"t":0.16324, "x":3.25661, "y":3.0346, "heading":-2.75047, "vx":0.5553, "vy":-0.94191, "omega":-3.0765, "ax":3.10187, "ay":-5.91375, "alpha":-18.84851, "fx":[-47.91414,13.24847,99.95578,131.6876], "fy":[-125.25892,-133.89195,-90.09071,-26.29915]}, - {"t":0.19044, "x":3.27287, "y":3.00679, "heading":-2.83417, "vx":0.63969, "vy":-1.1028, "omega":-3.58929, "ax":2.96499, "ay":-6.00696, "alpha":-18.57749, "fx":[-48.02119,8.52687,96.68132,131.09886], "fy":[-124.9528,-134.20409,-93.51921,-28.78368]}, - {"t":0.21765, "x":3.29137, "y":2.97456, "heading":-2.93182, "vx":0.72035, "vy":-1.26623, "omega":-4.09471, "ax":2.83266, "ay":-6.1286, "alpha":-18.0159, "fx":[-46.11856,3.15017,92.66591,130.1844], "fy":[-125.21011,-134.32759,-97.38889,-32.25746]}, - {"t":0.24485, "x":3.31202, "y":2.93785, "heading":-3.04322, "vx":0.79742, "vy":-1.43296, "omega":-4.58485, "ax":2.74135, "ay":-6.28212, "alpha":-16.9988, "fx":[-39.83904,-2.74256,87.85282,128.81283], "fy":[-126.46781,-134.14688,-101.57468,-36.74396]}, - {"t":0.27206, "x":3.33472, "y":2.89654, "heading":3.11523, "vx":0.872, "vy":-1.60387, "omega":-5.04732, "ax":2.78158, "ay":-6.45463, "alpha":-15.28089, "fx":[-23.59255,-8.81852,82.2504,126.79931], "fy":[-128.4783,-133.49312,-105.82134,-42.0952]}, - {"t":0.29926, "x":3.35948, "y":2.85051, "heading":2.97791, "vx":0.94767, "vy":-1.77947, "omega":-5.46305, "ax":3.14432, "ay":-6.49887, "alpha":-12.86759, "fx":[14.53175,-14.31653,75.84588,123.61268], "fy":[-123.48498,-131.81397,-109.52444,-47.87406]}, - {"t":0.32647, "x":3.38642, "y":2.7997, "heading":2.82929, "vx":1.03322, "vy":-1.95628, "omega":-5.81312, "ax":3.24944, "ay":-4.51233, "alpha":-4.58665, "fx":[45.91444,31.83084,56.4062,72.19734], "fy":[-60.52124,-84.927,-79.20998,-61.88789]}, - {"t":0.35368, "x":3.41574, "y":2.7448, "heading":2.67114, "vx":1.12162, "vy":-2.07904, "omega":-5.93791, "ax":-3.8611, "ay":4.99071, "alpha":17.08774, "fx":[-112.57066,44.07254,-57.39923,-119.29412], "fy":[14.66196,124.35313,120.03871,57.87121]}, - {"t":0.38088, "x":3.44482, "y":2.69009, "heading":2.50959, "vx":1.01658, "vy":-1.94327, "omega":-5.47302, "ax":-3.87695, "ay":5.37141, "alpha":16.76632, "fx":[-127.85378,45.81561,-49.5909,-114.56866], "fy":[22.32508,125.14729,124.46479,69.16301]}, - {"t":0.40809, "x":3.47104, "y":2.63921, "heading":2.36069, "vx":0.9111, "vy":-1.79713, "omega":-5.01688, "ax":-3.68306, "ay":5.44065, "alpha":17.65072, "fx":[-131.47708,49.12504,-41.76794,-109.76521], "fy":[16.33955,124.32208,127.61077,77.22455]}, - {"t":0.43529, "x":3.49447, "y":2.59233, "heading":2.2242, "vx":0.8109, "vy":-1.64912, "omega":-4.53667, "ax":-3.46666, "ay":5.55293, "alpha":18.08299, "fx":[-132.58035,51.72156,-34.33418,-104.94992], "fy":[15.27189,123.45778,129.95497,83.94301]}, - {"t":0.4625, "x":3.51525, "y":2.54952, "heading":2.10078, "vx":0.71659, "vy":-1.49804, "omega":-4.04471, "ax":-3.26984, "ay":5.68404, "alpha":18.1452, "fx":[-132.87589,53.0002,-27.49392,-100.27505], "fy":[16.65448,123.00873,131.65714,89.63272]}, - {"t":0.48971, "x":3.53353, "y":2.51087, "heading":1.99074, "vx":0.62763, "vy":-1.3434, "omega":-3.55105, "ax":-3.10543, "ay":5.81846, "alpha":17.93957, "fx":[-132.80862,52.78635,-21.31934,-95.86218], "fy":[19.05933,123.14404,132.85235,94.43368]}, - {"t":0.51691, "x":3.54946, "y":2.47647, "heading":1.89413, "vx":0.54314, "vy":-1.18511, "omega":-3.06299, "ax":-2.97928, "ay":5.94836, "alpha":17.54506, "fx":[-132.55349,51.01575,-15.84208,-91.8135], "fy":[21.74244,123.90172,133.65545,98.43863]}, - {"t":0.54412, "x":3.56313, "y":2.44643, "heading":1.8108, "vx":0.46209, "vy":-1.02328, "omega":-2.58566, "ax":-2.89195, "ay":6.06868, "alpha":17.03395, "fx":[-132.21216,47.80691,-11.04654,-88.19559], "fy":[24.30366,125.17092,134.16645,101.73815]}, - {"t":0.57132, "x":3.57463, "y":2.42084, "heading":1.74045, "vx":0.38341, "vy":-0.85817, "omega":-2.12224, "ax":-2.84091, "ay":6.17526, "alpha":16.4728, "fx":[-131.85733,43.41916,-6.91114,-85.05706], "fy":[26.52453,126.74659,134.46618,104.41003]}, - {"t":0.59853, "x":3.58401, "y":2.39978, "heading":1.68271, "vx":0.30612, "vy":-0.69017, "omega":-1.67408, "ax":-2.81926, "ay":6.26416, "alpha":15.92791, "fx":[-131.54281,38.3439,-3.40639,-82.42595], "fy":[28.2897,128.35741,134.61968,106.52546]}, - {"t":0.62574, "x":3.5913, "y":2.38332, "heading":1.63717, "vx":0.22942, "vy":-0.51975, "omega":-1.24075, "ax":-2.8156, "ay":6.33188, "alpha":15.46417, "fx":[-131.30842,33.33402,-0.50511,-80.3194], "fy":[29.53525,129.73589,134.67803,108.14345]}, - {"t":0.65294, "x":3.5965, "y":2.37152, "heading":1.60341, "vx":0.15282, "vy":-0.34748, "omega":-0.82003, "ax":-2.8153, "ay":6.37624, "alpha":15.13899, "fx":[-131.18156,29.33644,1.81284,-78.74741], "fy":[30.22614,130.69257,134.68093,109.31049]}, - {"t":0.68015, "x":3.59961, "y":2.36443, "heading":1.5811, "vx":0.07623, "vy":-0.17401, "omega":-0.40816, "ax":-2.80181, "ay":6.39608, "alpha":15.00266, "fx":[-131.18015,27.41302,3.56066,-77.71649], "fy":[30.33531,131.11543,134.65867,110.06012]}, - {"t":0.70735, "x":3.60065, "y":2.36206, "heading":1.57, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], + {"t":0.0, "x":3.36426, "y":2.44886, "heading":-2.19754, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.16326, "ay":-0.07016, "alpha":-36.50693, "fx":[-130.49399,16.76289,131.72926,-7.63084], "fy":[-32.86919,-133.53554,27.59095,134.35821]}, + {"t":0.02069, "x":3.36429, "y":2.44884, "heading":-2.19754, "vx":0.00338, "vy":-0.00145, "omega":-0.75517, "ax":0.18213, "ay":-0.07825, "alpha":-36.48846, "fx":[-130.35574,17.26477,131.73753,-7.08066], "fy":[-33.17801,-133.41749,27.29488,134.33169]}, + {"t":0.04137, "x":3.3644, "y":2.4488, "heading":-2.21316, "vx":0.00714, "vy":-0.00307, "omega":-1.50996, "ax":0.20949, "ay":-0.09078, "alpha":-36.4604, "fx":[-130.67719,15.96704,132.1366,-4.12337], "fy":[-31.51794,-133.499,24.88104,134.371]}, + {"t":0.06206, "x":3.36459, "y":2.44871, "heading":-2.2444, "vx":0.01148, "vy":-0.00495, "omega":-2.26417, "ax":0.25304, "ay":-0.11163, "alpha":-36.41287, "fx":[-131.33523,13.10707,132.79773,1.49939], "fy":[-27.96234,-133.67976,20.26516,134.28833]}, + {"t":0.08274, "x":3.36488, "y":2.44859, "heading":-2.29123, "vx":0.01671, "vy":-0.00726, "omega":-3.01739, "ax":0.33816, "ay":-0.15346, "alpha":-36.31419, "fx":[-132.03134,9.45016,133.45132,10.60422], "fy":[-22.81812,-133.7383,13.20177,133.60976]}, + {"t":0.10343, "x":3.3653, "y":2.44841, "heading":-2.35365, "vx":0.02371, "vy":-0.01043, "omega":-3.76858, "ax":0.56677, "ay":-0.26975, "alpha":-36.00174, "fx":[-131.96888,8.05819,133.47263,26.42974], "fy":[-17.5184,-133.15715,2.89942,130.64627]}, + {"t":0.12411, "x":3.36591, "y":2.44813, "heading":-2.4316, "vx":0.03543, "vy":-0.01601, "omega":-4.5133, "ax":4.07353, "ay":-2.34497, "alpha":-23.39207, "fx":[-39.05131,65.26737,126.73363,105.73115], "fy":[-86.37221,-108.5697,-20.97501,67.00446]}, + {"t":0.1448, "x":3.36752, "y":2.4473, "heading":-2.52496, "vx":0.1197, "vy":-0.06452, "omega":-4.99718, "ax":6.89835, "ay":-2.41079, "alpha":-0.01865, "fx":[109.54655,109.44724,109.52306,109.54852], "fy":[-38.24676,-38.47404,-38.18606,-38.18534]}, + {"t":0.16549, "x":3.37147, "y":2.44545, "heading":-2.62833, "vx":0.26239, "vy":-0.11439, "omega":-4.99756, "ax":6.71043, "ay":-2.57894, "alpha":0.0, "fx":[106.66259,106.46726,106.52781,106.47454], "fy":[-40.6373,-41.12569,-40.95143,-41.056]}, + {"t":0.18617, "x":3.37833, "y":2.44253, "heading":-2.73171, "vx":0.4012, "vy":-0.16773, "omega":-4.99756, "ax":6.66713, "ay":-2.1615, "alpha":0.0, "fx":[105.80478,105.86901,105.8388,105.86948], "fy":[-34.40157,-34.21947,-34.38908,-34.25141]}, + {"t":0.20686, "x":3.38806, "y":2.4386, "heading":-2.83509, "vx":0.53912, "vy":-0.21245, "omega":-4.99756, "ax":6.01141, "ay":-2.29272, "alpha":0.00001, "fx":[95.66524,95.48976,95.65611,94.93106], "fy":[-35.78599,-36.66324,-36.49811,-36.64732]}, + {"t":0.22754, "x":3.4005, "y":2.43371, "heading":-2.93847, "vx":0.66347, "vy":-0.25987, "omega":-4.99756, "ax":6.20433, "ay":-1.7347, "alpha":0.0, "fx":[98.43868,98.50739,98.51346,98.53349], "fy":[-27.5987,-27.34277,-27.70626,-27.51092]}, + {"t":0.24823, "x":3.41555, "y":2.42797, "heading":-3.04185, "vx":0.79181, "vy":-0.29576, "omega":-4.99756, "ax":4.09883, "ay":-1.51793, "alpha":0.0, "fx":[65.31493,65.26765,65.4466,64.25868], "fy":[-23.48031,-24.35754,-24.32495,-24.22994]}, + {"t":0.26891, "x":3.43281, "y":2.42152, "heading":3.13796, "vx":0.87659, "vy":-0.32716, "omega":-4.99756, "ax":4.3544, "ay":-0.9729, "alpha":0.0, "fx":[69.05316,69.07222,69.19744,69.19465], "fy":[-15.52718,-15.16245,-15.57495,-15.51716]}, + {"t":0.2896, "x":3.45187, "y":2.41455, "heading":3.03458, "vx":0.96667, "vy":-0.34728, "omega":-4.99756, "ax":1.43015, "ay":-0.44955, "alpha":0.0, "fx":[22.79712,22.7891,22.87369,22.35909], "fy":[-6.88877,-7.23936,-7.24611,-7.17356]}, + {"t":0.31029, "x":3.47217, "y":2.40727, "heading":2.93121, "vx":0.99625, "vy":-0.35658, "omega":-4.99756, "ax":-0.04082, "ay":0.12186, "alpha":0.0, "fx":[-0.64993,-0.65084,-0.64622,-0.64532], "fy":[1.93051,1.95761,1.92181,1.92878]}, + {"t":0.33097, "x":3.49277, "y":2.39992, "heading":2.82783, "vx":0.99541, "vy":-0.35406, "omega":-4.99756, "ax":-1.43475, "ay":0.69067, "alpha":0.0, "fx":[-22.88296,-22.8388,-22.98272,-22.40614], "fy":[10.73048,11.05316,11.09926,10.97676]}, + {"t":0.35166, "x":3.51306, "y":2.39274, "heading":2.72445, "vx":0.96573, "vy":-0.33977, "omega":-4.99756, "ax":-4.39509, "ay":1.19221, "alpha":0.0, "fx":[-69.74463,-69.73777,-69.796,-69.82292], "fy":[19.017,18.66982,19.01389,19.00789]}, + {"t":0.37234, "x":3.53209, "y":2.38597, "heading":2.62107, "vx":0.87481, "vy":-0.31511, "omega":-4.99756, "ax":-4.09219, "ay":1.73626, "alpha":0.0, "fx":[-65.28419,-65.09613,-65.31388,-64.17189], "fy":[26.91218,27.73718,27.86241,27.74562]}, + {"t":0.39303, "x":3.54931, "y":2.37982, "heading":2.51769, "vx":0.79016, "vy":-0.2792, "omega":-4.99756, "ax":-6.18281, "ay":1.89489, "alpha":-0.00002, "fx":[-98.14153,-98.20728,-98.12837,-98.14927], "fy":[30.12994,29.8043,30.22728,30.16938]}, + {"t":0.41371, "x":3.56433, "y":2.37445, "heading":2.41432, "vx":0.66227, "vy":-0.24, "omega":-4.99756, "ax":-5.98321, "ay":2.46223, "alpha":0.00003, "fx":[-95.32989,-95.1031,-95.11476,-94.4037], "fy":[38.48983,39.15113,39.21907,39.4986]}, + {"t":0.4344, "x":3.57675, "y":2.37001, "heading":2.31094, "vx":0.5385, "vy":-0.18907, "omega":-4.99756, "ax":-6.64311, "ay":2.27, "alpha":-0.00003, "fx":[-105.45111,-105.52631,-105.43637,-105.44327], "fy":[36.07818,35.83318,36.12944,36.11071]}, + {"t":0.45508, "x":3.58647, "y":2.36659, "heading":2.20756, "vx":0.40108, "vy":-0.14211, "omega":-4.99756, "ax":-6.67413, "ay":2.69485, "alpha":0.00003, "fx":[-106.10307,-105.98489,-106.00602,-105.73295], "fy":[42.47632,42.85256,42.65175,43.15006]}, + {"t":0.47577, "x":3.59334, "y":2.36423, "heading":2.10418, "vx":0.26302, "vy":-0.08636, "omega":-4.99756, "ax":-6.89209, "ay":2.44516, "alpha":0.01912, "fx":[-109.4832,-109.49577,-109.37356,-109.31527], "fy":[38.63819,38.63176,38.94065,39.06403]}, + {"t":0.49646, "x":3.59731, "y":2.36296, "heading":2.0008, "vx":0.12046, "vy":-0.03578, "omega":-4.99717, "ax":-4.05635, "ay":1.29776, "alpha":23.3761, "fx":[-112.28964,26.7308,-53.5522,-118.47896], "fy":[-56.78504,-25.60738,114.63647,50.16751]}, + {"t":0.51714, "x":3.59893, "y":2.3625, "heading":1.89743, "vx":0.03655, "vy":-0.00894, "omega":-4.51362, "ax":-0.58012, "ay":0.13217, "alpha":36.01263, "fx":[-66.96027,113.25426,33.69065,-116.82384], "fy":[-115.33251,-69.93992,129.01934,64.64657]}, + {"t":0.53783, "x":3.59956, "y":2.36234, "heading":1.80407, "vx":0.02455, "vy":-0.00621, "omega":-3.76867, "ax":-0.34773, "ay":0.08188, "alpha":36.31709, "fx":[-71.50927,107.27238,52.86038,-110.70522], "fy":[-113.39676,-80.27646,123.18125,75.69158]}, + {"t":0.55851, "x":3.6, "y":2.36223, "heading":1.72611, "vx":0.01736, "vy":-0.00451, "omega":-3.01743, "ax":-0.26194, "ay":0.06493, "alpha":36.4138, "fx":[-78.00867,101.06474,64.90727,-104.59754], "fy":[-109.34137,-88.40892,117.57668,84.29693]}, + {"t":0.5792, "x":3.6003, "y":2.36215, "heading":1.66369, "vx":0.01194, "vy":-0.00317, "omega":-2.26418, "ax":-0.21728, "ay":0.05602, "alpha":36.46087, "fx":[-83.61401,95.55185,73.44506,-99.18106], "fy":[-105.28554,-94.54854,112.60203,90.78918]}, + {"t":0.59988, "x":3.6005, "y":2.3621, "heading":1.61686, "vx":0.00744, "vy":-0.00201, "omega":-1.50997, "ax":-0.18942, "ay":0.0506, "alpha":36.48867, "fx":[-87.82488,91.17701,79.43234,-94.81302], "fy":[-101.90579,-98.89374,108.56379,95.44908]}, + {"t":0.62057, "x":3.60061, "y":2.36207, "heading":1.58562, "vx":0.00352, "vy":-0.00096, "omega":-0.75517, "ax":-0.17038, "ay":0.04655, "alpha":36.50702, "fx":[-90.55911,88.18236,83.3044,-91.74709], "fy":[-99.5572,-101.65061,105.69288,98.47072]}, + {"t":0.64126, "x":3.60065, "y":2.36206, "heading":1.57, "vx":0.0, "vy":0.0, "omega":0.0, "ax":0.0, "ay":0.0, "alpha":0.0, "fx":[0.0,0.0,0.0,0.0], "fy":[0.0,0.0,0.0,0.0]}], "splits":[0] }, "events":[] diff --git a/src/main/java/frc/robot/AutoRoutines.java b/src/main/java/frc/robot/AutoRoutines.java index 12cc4599..7e236de3 100644 --- a/src/main/java/frc/robot/AutoRoutines.java +++ b/src/main/java/frc/robot/AutoRoutines.java @@ -16,6 +16,7 @@ import frc.robot.Constants.Swerve.Auto.ShootPos; import frc.robot.commandGroups.IntakeToBumpDTP; import frc.robot.commandGroups.ShootCommandGroups.ShootWithAim; +import frc.robot.commandGroups.ShootToBumpDTP; import frc.robot.subsystems.CommandSwerveDrivetrain; import frc.robot.subsystems.HopperSubsystem; import frc.robot.subsystems.IntakeSubsystem; @@ -110,7 +111,7 @@ public Command returnBasicShoot(BooleanSupplier isRedSide) { swerveSubsystem, isRedSide, () -> false) - .withTimeout(4.0); + .withTimeout(3.5); return shoot; } @@ -131,6 +132,22 @@ public Command returnBasicShootLessTime(BooleanSupplier isRedSide) { return shoot; } + public Command returnBasicShootMoreTime(BooleanSupplier isRedSide) { + Command shoot = + new ShootWithAim( + () -> 0.0, + () -> 0.0, + lebronShooterSubsystem, + intakeSubsystem, + hopperSubsystem, + swerveSubsystem, + isRedSide, + () -> false) + .withTimeout(4.2); + + return shoot; + } + public Command driveForward(double time) { return Commands.run( () -> swerveSubsystem.applyFieldSpeeds(new ChassisSpeeds(3, 0, 0), new Feedforwards(4)), @@ -180,6 +197,11 @@ public Command driveToBumpAfterIntake(BooleanSupplier isRedSide, BooleanSupplier return new IntakeToBumpDTP(swerveSubsystem, isRedSide, isLeftSide); } + public Command driveToBumpAfterShoot(BooleanSupplier isRedSide, BooleanSupplier isLeftSide) { + // return new IntakeToBumpDTP(swerveSubsystem, isRedSide).withTimeout(0.5); + return new ShootToBumpDTP(swerveSubsystem, isRedSide, isLeftSide); + } + // Middle public AutoRoutine Nike() { AutoRoutine routine = autoFactory.newRoutine("CristianoRonaldo.chor"); @@ -306,6 +328,132 @@ public AutoRoutine PedriShortLeft() { return routine; } + public AutoRoutine PedriShortRightWait() { + AutoRoutine routine = autoFactory.newRoutine("CristianoRonaldo.chor"); + + Command forward = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + Command forward2 = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward2 = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + + AutoTrajectory intake1 = intake(routine, Constants.Swerve.Auto.Intake.RightIntakeSweepShort); + AutoTrajectory intakeToShoot1 = shoot(routine, Constants.Swerve.Auto.ShootPos.RightShoot); + AutoTrajectory shootToBump = + miscPaths(routine, Constants.Swerve.Auto.MiscPaths.RightShootToBump); + AutoTrajectory intake2 = intake(routine, Constants.Swerve.Auto.Intake.RightSecondDip); + AutoTrajectory intakeToShoot2 = shoot(routine, Constants.Swerve.Auto.ShootPos.RightShoot); + + routine + .active() + .onTrue( + Commands.sequence( + Commands.waitSeconds(Constants.Swerve.Auto.WAIT_TIME_FOR_ALLIANCE), + forward, + intake1.resetOdometry(), + intake1.cmd())); + + intake1 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> false), + backward, + intakeToShoot1.resetOdometry(), + intakeToShoot1.cmd())); + + intakeToShoot1.done().onTrue(Commands.sequence(returnBasicShoot(redSide), shootToBump.cmd())); + + shootToBump.done().onTrue(Commands.sequence(forward2, intake2.resetOdometry(), intake2.cmd())); + + intake2 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> false), + backward2, + intakeToShoot2.resetOdometry(), + intakeToShoot2.cmd())); + + intakeToShoot2.done().onTrue(returnBasicShoot(redSide)); + + return routine; + } + + public AutoRoutine PedriShortLeftWait() { + AutoRoutine routine = autoFactory.newRoutine("CristianoRonaldo.chor"); + + Command forward = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + Command forward2 = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward2 = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + + AutoTrajectory intake1 = intake(routine, Constants.Swerve.Auto.Intake.LeftIntakeSweepShort); + AutoTrajectory intakeToShoot1 = shoot(routine, Constants.Swerve.Auto.ShootPos.LeftShoot); + AutoTrajectory shootToBump = + miscPaths(routine, Constants.Swerve.Auto.MiscPaths.LeftShootToBump); + AutoTrajectory intake2 = intake(routine, Constants.Swerve.Auto.Intake.LeftSecondDip); + AutoTrajectory intakeToShoot2 = shoot(routine, Constants.Swerve.Auto.ShootPos.LeftShoot); + + routine + .active() + .onTrue( + Commands.sequence( + Commands.waitSeconds(Constants.Swerve.Auto.WAIT_TIME_FOR_ALLIANCE), + forward, + intake1.resetOdometry(), + intake1.cmd())); + + intake1 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> true), + backward, + intakeToShoot1.resetOdometry(), + intakeToShoot1.cmd())); + + intakeToShoot1.done().onTrue(Commands.sequence(returnBasicShoot(redSide), shootToBump.cmd())); + + shootToBump.done().onTrue(Commands.sequence(forward2, intake2.resetOdometry(), intake2.cmd())); + + intake2 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> true), + backward2, + intakeToShoot2.resetOdometry(), + intakeToShoot2.cmd())); + + intakeToShoot2.done().onTrue(returnBasicShoot(redSide)); + + return routine; + } + public AutoRoutine HubSweepRight() { AutoRoutine routine = autoFactory.newRoutine("CristianoRonaldo.chor"); @@ -436,7 +584,7 @@ public AutoRoutine HubSweepLeft() { public AutoRoutine DrakeOutpostShort() { AutoRoutine routine = autoFactory.newRoutine("CristianoRonaldo.chor"); - AutoTrajectory outpostIntake = outpost(routine, Constants.Swerve.Auto.Outpost.OutpostStartPush); + AutoTrajectory outpostIntake = outpost(routine, Constants.Swerve.Auto.Outpost.OutpostStart); routine.active().onTrue(Commands.sequence(outpostIntake.resetOdometry(), outpostIntake.cmd())); @@ -498,16 +646,118 @@ public AutoRoutine DrakeDepotLong() { return routine; } - public AutoRoutine anthony() { + public AutoRoutine PedriShortRightHub() { AutoRoutine routine = autoFactory.newRoutine("CristianoRonaldo.chor"); - AutoTrajectory depotIntake = miscPaths(routine, Constants.Swerve.Auto.MiscPaths.anthony); + Command forward = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + Command forward2 = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward2 = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + + AutoTrajectory intake1 = intake(routine, Constants.Swerve.Auto.Intake.RightIntakeSweepShort); + AutoTrajectory intakeToShoot1 = shoot(routine, Constants.Swerve.Auto.ShootPos.RightShoot); + AutoTrajectory shootToBump = + miscPaths(routine, Constants.Swerve.Auto.MiscPaths.RightShootToBump); + AutoTrajectory intake2 = intake(routine, Constants.Swerve.Auto.Intake.HubRight); + AutoTrajectory intakeToShoot2 = shoot(routine, Constants.Swerve.Auto.ShootPos.RightShoot); - // routine.active().onTrue(Commands.sequence(depotIntake.resetOdometry(), depotIntake.cmd())); - // depotIntake.done().onTrue(Commands.sequence(returnBasicShoot(redSide).asProxy(), - // outpostIntake.cmd())); - // outpostIntake.done().onTrue(returnBasicShoot(redSide)); - routine.active().onTrue(Commands.sequence(depotIntake.resetOdometry(), depotIntake.cmd())); + routine.active().onTrue(Commands.sequence(forward, intake1.resetOdometry(), intake1.cmd())); + + intake1 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> false), + backward, + intakeToShoot1.resetOdometry(), + intakeToShoot1.cmd())); + + intakeToShoot1 + .done() + .onTrue(Commands.sequence(returnBasicShootMoreTime(redSide), shootToBump.cmd())); + + shootToBump.done().onTrue(Commands.sequence(forward2, intake2.resetOdometry(), intake2.cmd())); + + intake2 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> false), + backward2, + intakeToShoot2.resetOdometry(), + intakeToShoot2.cmd())); + + intakeToShoot2.done().onTrue(returnBasicShootMoreTime(redSide)); + + return routine; + } + + public AutoRoutine PedriShortLeftHub() { + AutoRoutine routine = autoFactory.newRoutine("CristianoRonaldo.chor"); + + Command forward = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + Command forward2 = + redSide.getAsBoolean() + ? driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS) + : driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_FORWARDS); + Command backward2 = + redSide.getAsBoolean() + ? driveForward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS) + : driveBackward(Constants.Swerve.Auto.TIME_FOR_BUMP_BACKWARDS); + + AutoTrajectory intake1 = intake(routine, Constants.Swerve.Auto.Intake.LeftIntakeSweepShort); + AutoTrajectory intakeToShoot1 = shoot(routine, Constants.Swerve.Auto.ShootPos.LeftShoot); + AutoTrajectory shootToBump = + miscPaths(routine, Constants.Swerve.Auto.MiscPaths.LeftShootToBump); + AutoTrajectory intake2 = intake(routine, Constants.Swerve.Auto.Intake.HubLeft); + AutoTrajectory intakeToShoot2 = shoot(routine, Constants.Swerve.Auto.ShootPos.LeftShoot); + + routine.active().onTrue(Commands.sequence(forward, intake1.resetOdometry(), intake1.cmd())); + + intake1 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> true), + backward, + intakeToShoot1.resetOdometry(), + intakeToShoot1.cmd())); + + intakeToShoot1 + .done() + .onTrue(Commands.sequence(returnBasicShootMoreTime(redSide), shootToBump.cmd())); + + shootToBump.done().onTrue(Commands.sequence(forward2, intake2.resetOdometry(), intake2.cmd())); + + intake2 + .done() + .onTrue( + Commands.sequence( + driveToBumpAfterIntake(redSide, () -> true), + backward2, + intakeToShoot2.resetOdometry(), + intakeToShoot2.cmd())); + + intakeToShoot2.done().onTrue(returnBasicShootMoreTime(redSide)); return routine; } @@ -516,8 +766,12 @@ public AutoRoutine anthony() { public void addCommandstoAutoChooser() { autoChooser.addRoutine("Right", () -> PedriShortRight()); autoChooser.addRoutine("Left", () -> PedriShortLeft()); - autoChooser.addRoutine("Hub Sweep Left", () -> HubSweepLeft()); - autoChooser.addRoutine("Hub Sweep Right", () -> HubSweepRight()); + autoChooser.addRoutine("Right Wait", () -> PedriShortRightWait()); + autoChooser.addRoutine("Left Wait", () -> PedriShortLeftWait()); + // autoChooser.addRoutine("Right then Hub", () -> PedriShortRightHub()); + // autoChooser.addRoutine("Left then Hub", () -> PedriShortLeftHub()); + autoChooser.addRoutine("Hub Sweep Left Wait", () -> HubSweepLeft()); + autoChooser.addRoutine("Hub Sweep Right Wait", () -> HubSweepRight()); autoChooser.addRoutine("Just Outpost", () -> DrakeOutpostShort()); autoChooser.addRoutine("Just Depot", () -> DrakeDepotShort()); @@ -525,7 +779,6 @@ public void addCommandstoAutoChooser() { autoChooser.addRoutine("Depot to Outpost", () -> DrakeDepotLong()); autoChooser.addRoutine("We are genuinely the worst robot on the field", () -> Nike()); - autoChooser.addRoutine("bad word", () -> anthony()); } public AutoChooser getAutoChooser() { diff --git a/src/main/java/frc/robot/Constants.java b/src/main/java/frc/robot/Constants.java index 2fd53bb9..55781d58 100644 --- a/src/main/java/frc/robot/Constants.java +++ b/src/main/java/frc/robot/Constants.java @@ -233,7 +233,7 @@ public static enum ChoreoPIDValues { SERRANO(0.1d, 0d, 0d, 0.1d, 0d, 0d, 3.867d, 0d, 0d), PROTO(0d, 0d, 0d, 0d, 0d, 0d, 0d, 0d, 0d), JAMES_HARDEN(0d, 0d, 0d, 0d, 0d, 0d, 0d, 0d, 0d), - COBRA(3.467, 0, 0, 3.567, 0, 0, 9.0, 0, 0); // 3.75 m/s^2 max accel while turning max, + COBRA(3.467, 0, 0, 3.567, 0, 0, 2.5, 0, 0); // 3.75 m/s^2 max accel while turning max, public final double kPX, kIX, kDX, kPY, kIY, kDY, kPR, kIR, kDR; ChoreoPIDValues( @@ -928,6 +928,23 @@ public static class Landmarks { new Translation2d(5.624283313751221, 2.281606435775757), new Rotation2d(1.57873264137917)); + public static Pose2d RED_LEFT_SHOOT_TO_BUMP = + new Pose2d( + new Translation2d(12.9309492111206055, 2.3620588779449463), + new Rotation2d(1.5707963267948966)); + public static Pose2d RED_RIGHT_SHOOT_TO_BUMP = + new Pose2d( + new Translation2d(12.951465606689453, 5.671574592590332), + new Rotation2d(-1.5707963267948966)); + public static Pose2d BLUE_LEFT_SHOOT_TO_BUMP = + new Pose2d( + new Translation2d(3.60064959526062, 5.671574592590332), + new Rotation2d(-1.5649821399611368)); + public static Pose2d BLUE_RIGHT_SHOOT_TO_BUMP = + new Pose2d( + new Translation2d(3.60064959526062, 2.3620588779449463), + new Rotation2d(1.57873264137917)); + public static Pose2d BLUE_PASSING_L = new Pose2d(2.111, 6.003, new Rotation2d()); public static Pose2d BLUE_PASSING_R = new Pose2d(2.111, 2.007, new Rotation2d()); diff --git a/src/main/java/frc/robot/Robot.java b/src/main/java/frc/robot/Robot.java index 61013351..fc589f9c 100644 --- a/src/main/java/frc/robot/Robot.java +++ b/src/main/java/frc/robot/Robot.java @@ -42,12 +42,13 @@ public void robotInit() { RobotContainer.isRedAlliance(); DogLog.setOptions( new DogLogOptions() - .withNtPublish(true) + .withNtPublish(false) .withCaptureDs(true) .withLogExtras(false) .withNtTunables(false)); DogLog.log("Elastic/FieldPose", m_robotContainer.drivetrain.getCurrentState().Pose); DogLog.log("Elastic/RedSide", RobotContainer.isRedAlliance()); + RobotController.setBrownoutVoltage(6.0); } /** @@ -78,6 +79,7 @@ private void elasticLogging() { DogLog.log("Elastic/FieldPose", m_robotContainer.drivetrain.getCurrentState().Pose); DogLog.log("Elastic/BatteryVoltage", RobotController.getBatteryVoltage()); DogLog.log("Elastic/AreWeActive", MiscUtils.areWeActive()); + SmartDashboard.putString("Elastic/ActiveFirst", MiscUtils.activeFirst()); DogLog.log("Elastic/TimeUntilNextShift", MiscUtils.countdownTillNextShift(simulatedTime)); SmartDashboard.putNumber( "Elastic/timeUntilNextShift", MiscUtils.countdownTillNextShift(simulatedTime)); diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java index dfa2c675..14cf8270 100644 --- a/src/main/java/frc/robot/RobotContainer.java +++ b/src/main/java/frc/robot/RobotContainer.java @@ -84,9 +84,10 @@ public class RobotContainer { public final LEDSubsystem leds = new LEDSubsystem( - MiscUtils::areWeActive, + () -> MiscUtils.areWeActive(2.0), () -> - Targeting.distMeters(drivetrain, Targeting.getHub(redside)) < 4 && inAllianceSide()); + Targeting.distMeters(drivetrain, Targeting.getHub(redside)) < 4.47 + && inAllianceSide()); // * KEEP FOR INTERMAP TESTING // private double hoodAngle = 18.369; @@ -143,14 +144,14 @@ private void configureBindings() { intakeSubsystem.setDefaultCommand(intakeSubsystem.intakeDefault()); joystick.leftBumper().whileTrue(intakeSubsystem.intakeUntilInterruptedCommand()); - // joystick - // .a() - // .whileTrue( - // intakeSubsystem - // .outtakeUntilInterruptedCommand() - // .alongWith( - // hopperSubsystem.runHopperUntilInterruptedCommand( - // -Constants.Hopper.TARGET_SURFACE_SPEED_MPS))); + joystick + .b() + .whileTrue( + intakeSubsystem + .outtakeUntilInterruptedCommand() + .alongWith( + hopperSubsystem.runHopperUntilInterruptedCommand( + -Constants.Hopper.TARGET_SURFACE_SPEED_MPS))); // * KEEP FOR WIN COMMAND // joystick diff --git a/src/main/java/frc/robot/commandGroups/ShootToBumpDTP.java b/src/main/java/frc/robot/commandGroups/ShootToBumpDTP.java new file mode 100644 index 00000000..4a85d5ae --- /dev/null +++ b/src/main/java/frc/robot/commandGroups/ShootToBumpDTP.java @@ -0,0 +1,24 @@ +package frc.robot.commandGroups; + +import edu.wpi.first.math.geometry.Pose2d; +import edu.wpi.first.wpilibj2.command.SequentialCommandGroup; +import frc.robot.Constants; +import frc.robot.commands.DriveToPose; +import frc.robot.subsystems.CommandSwerveDrivetrain; +import java.util.function.BooleanSupplier; + +public class ShootToBumpDTP extends SequentialCommandGroup { + public ShootToBumpDTP( + CommandSwerveDrivetrain swerve, BooleanSupplier isRedSide, BooleanSupplier isLeftSide) { + Pose2d pose = + isRedSide.getAsBoolean() + ? isLeftSide.getAsBoolean() + ? Constants.Landmarks.RED_LEFT_SHOOT_TO_BUMP + : Constants.Landmarks.RED_RIGHT_SHOOT_TO_BUMP + : isLeftSide.getAsBoolean() + ? Constants.Landmarks.BLUE_LEFT_SHOOT_TO_BUMP + : Constants.Landmarks.BLUE_RIGHT_SHOOT_TO_BUMP; + + addCommands(new DriveToPose(swerve, () -> pose)); + } +} diff --git a/src/main/java/frc/robot/commands/SwerveCommands/SwerveJoystickCommand.java b/src/main/java/frc/robot/commands/SwerveCommands/SwerveJoystickCommand.java index 250521fc..e83da5a6 100644 --- a/src/main/java/frc/robot/commands/SwerveCommands/SwerveJoystickCommand.java +++ b/src/main/java/frc/robot/commands/SwerveCommands/SwerveJoystickCommand.java @@ -101,10 +101,12 @@ public void execute() { double speedMagnitude = Math.sqrt(xSpeed * xSpeed + ySpeed * ySpeed); if (capper.getAsBoolean()) { - if (speedMagnitude > 2.0) { - xSpeed *= (2.0 / speedMagnitude); - ySpeed *= (2.0 / speedMagnitude); - } + xSpeed *= 0.3; + ySpeed *= 0.3; + // if (speedMagnitude > 2.0) { + // xSpeed *= (2.0 / speedMagnitude); + // ySpeed *= (2.0 / speedMagnitude); + // } } // Final values to apply to drivetrain diff --git a/src/main/java/frc/robot/util/MiscUtils.java b/src/main/java/frc/robot/util/MiscUtils.java index c59dd309..cd272de2 100644 --- a/src/main/java/frc/robot/util/MiscUtils.java +++ b/src/main/java/frc/robot/util/MiscUtils.java @@ -31,7 +31,7 @@ public static Pose2d plusWithRotation(Pose2d a, Pose2d b) { // Transform2d used public static Alliance getSecondAlliance() { String allianceChar = DriverStation.getGameSpecificMessage(); - if (allianceChar.isEmpty()) return null; + if (allianceChar == null || allianceChar.isEmpty()) return null; return switch (allianceChar.charAt(0)) { case 'B' -> Alliance.Blue; case 'R' -> Alliance.Red; @@ -39,7 +39,24 @@ public static Alliance getSecondAlliance() { }; } + public static String activeFirst() { + Optional alliance = DriverStation.getAlliance(); + if (alliance.isEmpty() || DriverStation.getMatchTime() < 105) return ""; + DogLog.log("Subsystems/LEDs/allianceNotEmpty", true); + Alliance ourAlliance = alliance.get(); + Alliance secondAlliance = getSecondAlliance(); + if (secondAlliance == null) return ""; + DogLog.log("Subsystems/LEDs/ourAlliance", ourAlliance.toString()); + DogLog.log("Subsystems/LEDs/secondAlliance", secondAlliance.toString()); + if (secondAlliance.equals(ourAlliance)) return "LATER"; + else return "NOW"; + } + public static boolean areWeActive() { + return areWeActive(0.0); + } + + public static boolean areWeActive(double howEarly) { Optional alliance = DriverStation.getAlliance(); if (alliance.isEmpty()) return false; @@ -48,24 +65,37 @@ public static boolean areWeActive() { // teleop is enabled double currentMatchTime = DriverStation.getMatchTime(); + double earlyMatchTime = currentMatchTime - howEarly; + String allianceChar = DriverStation.getGameSpecificMessage(); - DogLog.log("Elastic/AllianceChar", allianceChar.isEmpty() ? "Empty" : allianceChar); + DogLog.log( + "Elastic/AllianceChar", + allianceChar == null || allianceChar.isEmpty() ? "Empty" : allianceChar); - if (allianceChar.isEmpty()) return true; + if (allianceChar == null || allianceChar.isEmpty()) return true; + Alliance secondAlliance = getSecondAlliance(); + if (secondAlliance == null) return true; boolean redInactiveFirst = getSecondAlliance() == Alliance.Red; - boolean shift1Active = + boolean weAreActiveFirst = switch (alliance.get()) { case Red -> !redInactiveFirst; case Blue -> redInactiveFirst; }; + DogLog.log("Subsystems/LEDs/matchTime", currentMatchTime); + + double earlyActiveFirst = weAreActiveFirst ? earlyMatchTime : currentMatchTime; + DogLog.log("Subsystems/LEDs/earlyActiveFirst", earlyActiveFirst); + double earlyActiveSecond = !weAreActiveFirst ? earlyMatchTime : currentMatchTime; + DogLog.log("Subsystems/LEDs/earlyActiveSecond", earlyActiveFirst); + if (currentMatchTime > 130) return true; - else if (currentMatchTime > 105) return shift1Active; - else if (currentMatchTime > 80) return !shift1Active; - else if (currentMatchTime > 55) return shift1Active; - else if (currentMatchTime > 30) return !shift1Active; + else if (earlyActiveSecond > 105) return weAreActiveFirst; + else if (earlyActiveFirst > 80) return !weAreActiveFirst; + else if (earlyActiveSecond > 55) return weAreActiveFirst; + else if (earlyActiveFirst > 30) return !weAreActiveFirst; else return true; }